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Abstract 

An  extended  Kalman  Filter  Is  developed  to  aid  the  tracking  of  an  air- 
to-air  missile  from  a maneuvering  target  aircraft.  The  filter  exploits 
knowledge  of  the  dominant  dynamic  effects  acting  on  a missile  that  Is  non- 
thrusting and  utilizing  a proportional  navigation  guidance  scheme,  l.e. 
accelerations  due  to  aerodynamic  forces.  It  Is  designed  to  provide  both 
dynamic  tracking  estimates  In  a local  Inertial  frame  and  estimates  of  the 
proportional  navigation  constant  and  another  pertinent  parameter. 

A feasibility  analysis  of  the  filter  Is  conducted.  Its  performance 
Is  compared  to  a more  conventional  filter  that  utilizes  a first  order 
Gauss-Markov  random  process  acceleration  model.  In  addition,  an  evalua- 
tion Is  made  of  the  filter's  capability  to  recover  from  large  Initial 
errors  In  state  estimates.  . 

The  study  establishes  ^t^  feasibility  of  the  modelling  approach. 

The  estimates  provided  by  the  designed  filter  are.  In  general,  less  sensi- 
tive to  system  measurement  noises.  The  filter  performance  Is  trajectory 
dependent,  however,  and  the  requirement  for  a higher  order  missile  model 
within  the  filter  system  model  Is  established  (a  zero-order  model  was  used 
to  develop  as  simple  a filter  as  would  provide  adequate  performance). 

The  results  of  the  study  strongly  suggest  that  the  navigation  constant 
can  be  estimated  by  the  filter.  The  recovery  analysis  provides  additional 
Insights  Into  the  filter's  ability  to  estimate  this  parameter.  It  gives  a 
general  Indication  of  the  effects  that  varying  the  Initial  variance  and 
noise  strength  (on  the  navigation  constant  channel)  have  on  the  tuning  and 
recovery  characteristics  of  the  navigation  constant  estimate.  A graphic 
filter  analysis  Is  Included  that  portrays  the  estimation  accuracy  and 
recovery  characteristics  of  the  filter. 


APPLICATION  OF  AN  EXTENDED  KALMAN  FILTER 
TO  AN  ADVANCED  FIRE  CONTROL  SYSTEM 


I.  Introduction 


Background  and  Motivation 

An  ever  increasing  amount  of  research  effort  is  being  directed  toward 
the  air-to-air  engagements  of  missiles  and  aircraft.  An  area  of  particular 
interest  is  the  defensive  capability  of  the  target  aircraft.  While  most 
current  defensive  measures  are  passive  in  nature,  it  is  possible  that  an 
active  defensive  capability  could  be  developed  to  Increase  aircraft 
survivability.  One  of  the  decisive  factors  in  such  a system  would  be  the 
ability  of  the  aircraft's  fire  control  system  to  track  a maneuvering 
target  accurately.  This  report  concerns  itself  with  the  development  of  a 
Kalman  Filter  to  aid  the  tracking  of  an  air-to-air  missile  from  a maneuvering 
target  aircraft  (the  tracker) . 

Several  works  have  been  accomplished  in  the  general  tracking  area 
(Refs  3 and  10).  In  most  cases,  in  order  to  simplify  filter  implementation, 
the  tracking  algorithms  have  been  implemented  in  the  line-of-sight  frame. 
However,  this  does  not  appear  to  be  an  appropriate  choice  of  frames  for  a 
multiple  target,  multiple  sensor  scenario.  In  such  cases,  it  is  highly 
probable  that  a transfer  alignment  would  be  required  to  combine  the  input 
data  available  and  then  route  it  to  a remote  tracking  platform.  Such  a 
scheme  would  be  computationally  cumbersome  if  several  llne-of-sight  frames 
were  involved.  Therefore,  it  is  highly  desirable  that  the  tracking  filter 
provide  state  estimates  and  predictions  in  a local  inertial/stationary 
frame.  Two  other  concerns  that  result  from  the  multiple  target  scenario 
are  Identification  of  target  type  and  knowledge  of  target  status.  Most 
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previous  works  In  the  tracking  area  have  not  specifically  addressed  these 
latter  two  areas. 

The  primary  concern  In  these  works  has  been  the  accurate  modelling 
of  mlsslle/alrcraf t dynamics  and  kinematics.  One  approach  has  been  to 
model  target  acceleration  as  a first  order  Markov  Process.  This  model  Is 
widely  used  and  has  given  satisfactory  results  In  several  studies.  It 
provides  for  random,  but  time  correlated  acceleration  of  the  vehicle  being 
tracked.  By  a proper  choice  of  process  noise  strength  and  time  correlation, 
the  first  order  Markov  model  Is  descriptive  of  a wide  range  of  targets 
(Ref  10:326).  While  the  model  Is  generic  In  nature  and  appears  particularly 
attractive  for  a maneuvering  aircraft  (l.e.,  man  In  the  loop).  It  disregards 
available  Information  In  the  case  of  several  state  of  the  art  alr-to-air 
and  surface-to-air  missiles. 

The  kinematics  of  most  missiles  are  determined  by  a guidance  package 
Implementing  proportional  navigation.  Easy  Implementation  and  high 
reliability  make  this  form  of  guidance  extremely  attractive.  In  the  linear 
case,  with  both  the  target  and  missile  of  constant  velocity,  proportional 
navigation  Is  an  optimal  solution  to  the  Intercept  problem.  Several  works 
have  been  accomplished  to  develop  optimal  guidance  schemes  for  the  more 
practical  nonlinear  case  (Ref  14).  In  general,  these  schemes  have  been 
too  complex  to  Implement.  In  several  cases,  the  form  of  the  optimal  solu- 
tion approximates  the  proportional  navigation  solution  - a time  varying 
proportional  navigation  constant  Is  one  such  approach. 

Proportional  navigation  commands  a missile  turning  rate  proportional 
to  the  rate  of  change  of  the  llne-of-slght  angle  between  the  missile  and 
target: 

y„  - ne  (1) 

n 
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where  y = rate  of  change  of  missile  heading,  y 
m m 

n = proportional  navigation  constant 

0 = rate  of  change  of  the  mlsslle-to-target  llne-of-slght  angle,  0, 
relative  to  an  Initial  missile  llne-of-slght  frame. 

The  Implementation  of  the  guidance  law  Is  discussed  In  greater  detail  In 
Chapter  Two.  In  addition  to  utilizing  proportional  navigation,  many 
current  missiles  are  "boosted  to  mach"  and  then  coast  to  Intercept.  For 
many  of  the  current  generation  of  missiles,  then.  It  can  be  assumed  that 
they  are  using  a form  of  proportional  navigation  and,  for  a large  segment 
of  their  flight  time,  they  are  non-thrusting. 

These  two  characteristics  provide  additional  Information  that  may  not 
only  Improve  the  estimation  and  prediction  capability  of  the  tracking 
filter,  but  provide  a means  of  predicting  missile  Identification  and  status. 
The  two  dominant  affects  on  a non-thrusting  missile  using  proportional 
navigation  are  the  deceleration  due  to  drag  and  the  lateral  acceleration 
due  to  commanded  acceleration. 

a*  = nV  0 (2) 

*’  c 

- I ‘>S”<So  * 

where  a^  ~ missile  lateral  acceleration  due  to  lift 

V * relative  closing  velocity  along  the  llne-of-slght 
c 

a^  * missile  acceleration  due  to  drag 

p * air  density 

S * reference  surface  area 

m ~ mass  of  missile 

CjjQ  ••  coefficient  of  zero-lift  drag 
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Cpj  ■ coefficient  of  induced  drag 

V * missile  velocity, 
m 

Equations  (2)  and  (3)  model  the  total  acceleration  for  the  assumed 
missile  conditions.  The  fact  that  gravity  is  neglected  is  discussed  in 
Chapter  Two.  In  addition,  the  equations  embody  three  coefficients,  namely 
^DI’  ^DO’  could,  if  they  themselves  are  accurately  estimated, 

provide  missile  Identification  and  status. 

Statement  of  the  Problem 

The  problem  is  then  to  design  a Kalman  Filter  to 

(1)  provide  desired  state  estimation  and  trajectory  prediction  capa- 
bility in  a local  inert lal/statlonary  frame, 

(2)  determine  the  feasibility  of  utilizing  Equations  (2)  and  (3)  to 
model  the  acceleration  of  a generic  tactical  missile  adequately, 

(3)  determine  the  feasibility  of  obtaining  accurate  estimates  of  the 
constants  in  Equations  (2)  and  (3)  or  some  other  parameter 
related  to  them,  and 

(4)  evaluate  the  estimation  and  prediction  capability  of  a Kalman 
Filter  that  Includes  the  additional  information  provided  in 
Equations  (2)  and  (3) . 

As  part  of  the  filter  formulation,  appropriate  models  of  the  three  unknown 
parameters  need  to  be  proposed  and  validated. 

In  addition  to  the  filter  containing  the  unknown  parameters,  a second 
filter  is  formulated.  The  purpose  of  this  filter  is  to  provide  a bench- 
mark against  which  the  first  filter  is  compared.  The  second  filter  utilizes 
the  first  order  Markov  Process  model  for  missile  acceleration  and  comes 
essentially  from  the  filter  design  presented  by  Landau  (Ref  6).  Both  of 
the  two  filters  are  Extended  Kalman  Filters  due  to  the  nonlinearities 
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resulting  from  Inertial  models  of  several  states  and  llne-'of-slght  measure- 
ments . 

Development  of  a "truth  model"  for  the  engagement  scenario  Is  another 
component  of  the  problem.  The  truth  model  Is  a development  of  missile 
parameters  and  dynamics,  target  parameters  and  dynamics,  and  system  kinematics 
and  uncertainties.  It  Is  the  "best  model"  of  the  real  world  In  that  It 
includes  as  many  effects  as  possible,  regardless  of  the  resulting  system 
complexity.  The  truth  model  Is  exercised  In  a computer  simulation  to  pro- 
vide nominal  trajectories  for  analysis  of  the  two  filters.  The  nominal 
trajectory  Is  a deterministic  (reference)  trajectory  that  starts  from  a 
known  set  of  Initial  conditions,  2c^(t^),  and  propagates  according  to 


X (t)  = Itx  (t),u(t),t] 

“ n " Ti 


(4) 


where  f[x  (t),u(t),t]  ■ a known  function  of  the  arguments 
n — 

x^(t)  ■ nominal  reference  trajectory 
ii(t)  ■ deterministic  forcing  function 
t “ time. 

Associated  with  the  nominal  trajectory  is  a sequence  of  nominal  sampled 
data  measurments,  ^(t^).  The  filter  utilizes  the  nominal  measurements, 
corrupted  by  an  additive  white  noise,  as  input  measurements. 

The  final  aspect  of  the  problem  Is  a Monte  Carlo  analysis  of  both 
filters  over  a nominal  trajectory.  The  nominal  trajectory  chosen  Is 
representative  of  a moderate  amount  of  missile  maneuvering.  The  two 
filters  are  tuned  against  this  nominal.  Both  filters  will  also  be  exercised 
against  a "hlgh-g"  trajectory  of  the  missile  to  demonstrate  the  sensitivity 
of  the  filter  to  the  various  extremes  of  missile  maneuvering.  It  will  also 
establish  whether  further  tuning  of  the  filter  Is  required. 
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Organization 


This  thesis  consists  of  five  chapters.  Chapter  One  outlines  the  motiva- 
tion and  background  for  Investigating  a more  complex  tracking  algorithm. 

The  algorithm  exploits  additional  knowledge  of  the  missile  and  models  the 
three  unknown  parameters  - proportional  navigation  constant,  zero-lift  drag 
coefficient,  and  Induced  drag  coefficient  - as  additional  states  or  as  a 
function  of  the  other  system  states.  Chapter  Two  develops  the  system  truth 
model  and  presents  the  assumptions  made  in  the  engagement  scenario.  Chapter 
Three  introduces  the  basic  Extended  Kalman  Filter  Equations  and  presents 
the  formulation  of  the  two  specific  filters  Investigated.  The  development 
of  the  unknown  parameter  models  are  also  Included  in  this  chapter.  Chapter 
Four  introduces  the  Monte  Carlo  analysis  utilized.  In  addition,  the  tuning 
process  and  problems  encountered  in  the  tuning  process  are  discussed  in  this 
chapter.  Chapter  Five  discusses  the  graphical  and  numerical  results.  Having 
demonstrated  concept  feasibility  (at  least  partially),  several  suggestions 
are  presented  for  future  studies  of  Interest.  The  appendix  contains  por- 
tions of  the  filter  development,  the  graphical  results,  and  the  description 
and  computer  listing  of  each  of  the  computer  programs  developed  for  this 
study. 


II.  System  Truth  Model 


Introduction 

This  chapter  develops  the  realistic  models  of  the  missile,  target, 
and  engagement  geometry.  The  models  developed  are  simulated  on  a digital 
computer  to  provide  nominal  trajectories  for  the  Monte  Carlo  analysis  of 
the  Extended  Kalman  Filters.  The  system  models  should  represent  the  dominant 
dynamics  and  nonllnearltles  of  the  engagement  scenario,  and  yet  be  repre- 
sentative of  a wide  spectrum  of  tactical  missiles.  The  model  Is  divided 
Into  several  components,  as  shown  In  Figure  1.  The  remainder  of  the  sec- 
tions In  this  chapter  will  develop  each  component  In  detail.  It  Is  Impor- 
tant to  note  that  the  primary  objective  of  this  report  Is  to  describe  and 
analyze  the  dynamics  and  motion  of  an  attacking  missile.  The  missile  sub- 
systems and  d3mamlcs  will,  therefore,  be  modelled  In  much  greater  detail 
than  other  truth  model  components.  Prior  to  discussing  the  individual 
components,  however,  the  assumptions  that  have  been  made  In  the  development 
of  the  model  are  presented. 

Assumptions.  Both  the  missile  and  target  aircraft  (tracker)  are 
assumed  to  be  point  masses.  In  addition,  measurements  of  the  tracker 
dynamics  are  assumed  to  enter  the  filter  algorithms  as  deterministic,  noise- 
less inputs.  Navigation  systems  that  are  currently  available  in  aircraft 
have  errors  that  are  second  or  lower  order  effects  when  compared  to  errors 
In  the  measurements  of  missile  dynamics.  Therefore,  this  assumption 
greatly  simplifies  the  system  model,  but  does  not  affect  model  Integrity. 

All  motion  Is  assumed  to  occur  In  the  horizontal  plane  (l.e.  constant 
altitude)  and  gravity  drop  Is  Ignored.  These  assumptions  allow  for  simpler 
modelling  of  certain  system  parameters.  The  model  could  be  extended  to 
Include  the  three-dimensional,  altitude  varying  case  If  more  detail  were 
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desired.  However,  the  Increased  model  complexity  is  not  required  to  achieve 
the  objectives  of  this  thesis.  It  is  further  asstmed  that  meteorological 
effects  can  be  Ignored.  This  assumption  appears  reasonable  since  the  time 
period  of  the  engagement  is  short,  both  the  missile  and  target  are  in  the 
same  air  mass,  and  finally  because  the  magnitudes  of  meteorological  effects 
will  in  general  be  second  order  in  comparison  to  missile  and  target  dynamics. 
Other  assumptions  that  are  peculiar  to  a particular  model  component  will  be 
discussed  in  the  applicable  section. 

Certain  sections  that  follow  are  largely  developed  in  (Ref  13) . The 
appropriate  sections  are  referenced  at  the  end  of  the  section. 

Missile  Seeker 

The  missile  seeker  serves  the  two  functions  of  measuring  target  motion 
and  of  tracking  the  target  with  the  antenna  device.  The  system  generally 
consists  of  a gimballed  platform  with  the  seeker  antenna  and  rate  gyros 
mounted  on  it.  In  the  planar  case,  only  one  glmbal  and  its  associated 
dynamics  need  be  considered.  The  specific  case  of  a radar  seeker  will  be 
considered,  but  the  principles  could  be  extended  to  Infrared  or  optical 
seekers. 

Measurement  Geometry . The  fundamental  measurement  obtained  from  the 
homing  sensor  is  the  indicated  angular  position  of  the  target  relative  to 
the  antenna  center  line  or  boreslght.  The  llne-of-slght  (LOS)  angle  or 
its  rate  of  change,  is  the  fundamental  quantity  used  in  a proportional 
navigation  scheme.  As  depicted  in  Figure  2 the  LOS  angle,  9,  is  the  angle 
between  a line  from  the  center  of  the  seeker  antenna  to  the  target,  and 
some  arbitrary  non-rotating  reference  frame. 


t 


To  get  the  desired  measurement  of  0 or  9,  as  opposed  to  an  Inertially 
stabilized  seeker  head,  it  is  necessary  to  remove  the  missile  motion  from 
the  LOS  measurement  data  as  measured  by  the  missile  guidance  package. 


One  requirement  of  the  seeker  antenna  is  that  it  continues  to  point 
at  the  target  in  order  to  keep  e small.  For  small  e,  the  boresight  error 
is  nearly  linear.  However,  if  the  boresight  error  is  not  small  compared 
to  antenna  bandwidth,  the  error  processing  operation  may  become  nonlinear. 
If  e is  allowed  to  approach  the  half  bandwidth  of  the  antenna,  the  receiver 
detection  unit  will  at  some  point  lose  lock  and  all  guidance  information 
will  be  lost.  The  nonlinearities  involved  are  functions  of  the  particular 
detection  scheme  used.  It  is  assumed  that  the  tracker  is  capable  of  keep- 
ing the  boresight  error  processor  in  its  linear  region. 

Aberration  Error . The  aberration  angle  error  is  the  result  of  non- 
linear distortions  in  the  received  energy  as  it  passes  the  protective 
covering  over  the  antenna.  The  distortion  produces  a false  boresight  error 
signal,  e',  which  is  Interpreted  as  target  motion  by  the  guidance  system 
of  the  missile.  As  depicted  in  Figure  3,  the  indicated  boresight  error 
with  aberration  error  present  is 


e'  = e + 0 - 0 - e (7) 

r m n 

The  size  of  the  measurement  error,  0^,  depends  upon  the  orientation  of  the 
antenna  relative  to  the  antenna  cover.  The  dependence  of  0^  on  0^  couples 
body  motion  into  the  boresight  error  signal  ("parasitic  attitude  loop") . 
This  effect  can  drastically  alter  missile  response  characteristics  and 
Increase  missile  miss  distance. 
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(9) 


e’  = (1  + k )(0  - e ) + 9 - e 

r m rb  ri 


In  the  above  expression,  the  boresight  error  bias  has  been  considered 
negligible  relative  to  the  other  errors  present. 
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Figure  4.  Seeker  System  Block  Diagram 

Seeker  Track  and  Stabilization  Loops.  Figure  4 depicts  the  seeker 
system  block  diagram.  The  constant  — scales  the  indicated  boresight 
error  to  obtain  the  desired  rate  command  for  the  guidance  system.  The 
stabilization  d3mamics  are  typically  comprised  of  a gimbal  servo  and  rate 
gyro  and  has  a very  wide  bandwidth.  The  track  loop  commands  a gimbal  rate 
proportional  to  measured  boresight  error.  The  loop  attempts  to  drive  bore- 
sight error  to  zero,  thereby  causing  the  antenna  to  track  the  target. 
Assuming  unity  gain  for  the  antenna  cover,  signal  processor,  and  stabiliza- 
tion dynamics,  it  is  seen  that 


^1 

1 + ST, 


For  0)  < — , the  indicated  boresight  error  is  proportional  to  the  LOS  rate. 
This  is  the  desired  relationship  for  classical  proportional  navigation. 

In  the  steady  state  case  with  0 a constant,  it  can  be  seen 


T 8' 

1 max 


If  is  sufficiently  small  in  this  relationship,  it  will  be  possible  to 
keep  e'  in  the  linear  range  of  the  received  beamwidth. 

The  importance  of  aberration  error  is  demonstrated  in  Figure  5 and 
the  relationship 


1 + Tj^S 


From  this  it  is  seen  that  the  LOS  rate,  0,  is  corrupted  by  a term  proper— 

tional  to  the  body  rate,  0 . The  body  rate  is  a function  of  commanded 

m 

acceleration,  and  the  loop  that  is  formed  can  have  a destabilizing  effect 
on  the  missile.  Note  that  if  = 0 in  Figure  5,  the  contribution  of  body 
rate  cancels  at  the  second  summing  junction. 


Figure  5.  Seeker  Model  Plus  Track  Loop 
14 


The  relationship  between  the  measured  LOS  angle  and  measured  LOS  rate 


can  be  determined  from  Figure  5 by  defining 

0'  = (1  + k )0  - k 0 
r r m 


(13) 


and  noting  that 


e»  , 0*  - e'/s 


(14) 


Substituting  the  expression,  e'  » Tj^0',  for  e'  and  solving  for  0'/0' 
yields 


9 * 8 

0'  1 +Tj^S 


(15) 


The  measured  LOS  angle,  0’,  is  depicted  in  the  truth  model  diagram  as  the 
input  to  the  seeker  module.  Tt  is  corrupted  by  an  additive  random  measure- 
ment noise.  The  noise  component  is  discussed  in  a later  section.  (Ref  13) 


Missile  Guidance 

Before  discussing  the  proportional  navigation  guidance  scheme  used  in 
this  study,  it  is  Important  to  note  the  distinction  between  "navigation", 
"guidance",  and  "control"  systems.  As  defined  by  Blakelock  (Ref  2),  the 
navigation  system  automatically  determines  the  position  of  the  vehicle 
with  respect  to  some  reference  frame  while  the  guidance  system  generates 
the  necessary  command  Inputs  to  the  control  system  to  keep  the  vehicle  on 
course.  The  control  system,  made  up  of  the  airframe  and  autopilot,  controls 
the  motion  of  the  vehicle.  The  missile  modelled  in  this  study  performs 
both  the  guidance  and  navigation  functions,  using  the  initial  LOS  frame 
for  both  purposes. 


\ 


r - 


The  operation  of  the  guidance  component  consists  of  filtering  the 
noisy  measurements  to  command  the  missile  lateral  acceleration.  A system 
using  a constant  bandwidth  low-pass  filter  and  having  a fast  measurement 
rate  can  be  characterized  as  an  analog  on-board  signal  processor  or  high 


rate  digital  unit. 

The  output  of  the  noise  filter  Is  a band  limited  representation  of 
the  LOS  rate.  Classical  proportional  navigation  develops  a lateral 
acceleration  command  for  the  missile  normal  to  the  LOS,  proportional  to 
the  LOS  rate,  given  by 


n'V 

a ” 

I cos(0^  - 0) 


(16-a) 


where  0^  represents  the  missile  lead  angle  and  n'  Is  a coefficient  related 

n * 

to  the  proportional  navigation  constant  of  Equation  (2)  by  n ■ tt 

cosvWj^  — o; 

The  term  cos(0j^  - 0)  Is  Included  In  the  above  expression  since  the  velocity 
vector  and  LOS  of  the  missile  may  not  be  coincident.  Since  the  missile 
acceleration  Is  developed  normal  to  the  missile  velocity  vector.  It  Is 

necessary  to  use  the  term  cos(0j^  - 0)  to  Increase  the  acceleration  so  that 

• 

the  projection  normal  to  the  LOS  will  be  proportional  to  the  LOS  rate,  0. 
However,  If  the  guidance  law  functions  properly,  0 will  remain  small  and 
0j^  will  be  relatively  small  In  addition  to  being  well  approximated  as  a 
constant.  The  result  is  that  the  cos(0^  - 0)  factor  can  be  considered 
constant  and  can  be  combined  with  n'  to  form  a redefined  proportional 
navigation  constant,  n (l.e.  Equation  (2)).  Therefore,  in  this  study  the 
value  of  "n"  will  remain  constant  unless  It  Is  changed  by  design. 

In  general,  the  navigation  constants  used  by  current  missiles  are 
In  the  range  of  three  to  six.  The  exact  value  of  the  constant  Is  usually 
based  on  a tradeoff  between  llne-of-slght  rate  noise  and  acceleration 
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saturation  (Ref  2).  ka  noted  previously,  some  optimal  schemes  employ  forms 
of  the  basic  proportional  guidance  scheme.  In  addition,  there  are  propor- 
tional navigation  plus  bias  and  proportional  navigation  plus  dead  space 
schemes  that  have  been  Implemented.  The  guidance  scheme  in  this  study  is 
classical  proportional  navigation.  The  assumed  model  for  the  guidance 
component  is  depicted  in  Figure  6. 


0' 

1 

A 

0' 

nV 

c 

a 

c 

1+T2S 

Figure  6.  Guidance  Law 
Airframe/Autopilot  Dynamics 

The  missile  model  adopted  is  based  largely  on  the  work  done  in 
(Refs  11,  12,  and  13).  The  model  that  is  simulated  is  a generic  model 
of  a cruciform,  air-to-air  missile  employing  a proportional  navigation 
guidance  scheme.  The  model  assumes  second  order  air  frame  dynamics  and 
first  order  actuator  dynamics.  It  also  Implements  an  adaptive  autopilot. 
Consideration  of  an  adaptive  autopilot  is  realistic  in  view  of  current 
interest  in  such  systems.  The  model  used  is  depicted  in  Figure  7.  It 
is  assumed  that  the  missile  is  non-thrusting  during  the  time  of  interest. 

As  indicated  in  the  thesis  Introduction,  this  is  not  overly  restrictive  - 
particularly  in  an  air-to-air  missile  scenario.  Addition  of  thrust  to  the 
model  would  also  add  additional  complexity  to  identifying  the  unknown 
parameters.  Prior  to  analyzing  the  dynamics  of  the  missile,  certain 
additional  assumptions  are  made. 

Assumptions.  For  the  purposes  of  the  autopilot  design,  it  is  assumed 
that  the  control  surface  lift  force  is  a linear  function  of  control  surface 
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Figure  7.  General  Missile  Autopilot  Configuration 


deflection  angle,  6,  and  independent  of  angle  of  attack,  a,  as  In  Figure  8. 
It  should  be  noted  that  In  (Refs  12  and  13),  linear  techniques  are  applied 
to  a nonlinear  model  since  "experience  has  shown  that  the  resulting  auto- 
pilot response  characteristics  with  the  nonlinear  airframe,  are  closely 
approximated  by  the  linearized  response  characteristics  near  the  given 
nominal  conditions,  for  a properly  designed  autopilot"  (Ref  13:A-16,A-17) . 
Unlike  the  models  used  In  these  references,  however,  the  model  In  this  study 
allows  for  velocity  change  as  a function  of  aerodynamic  drag.  In  addition, 
the  study  In  (Ref  13)  also  assumed  a constant  center  of  mass  and  center  of 
pressure.  These  restrictive  assumptions  have  been  removed  to  allow  a more 
realistic  depiction  of  system  characteristics. 


Figure  8.  Geometrical  Definitions  of  Yaw  Plane  Variables 

Airframe  Dynamics.  By  utilizing  a cruciform  missile,  the  pitch  and 
yaw  d3mamlcs  are  Identical,  and  the  roll  control  system  Is  primarily  for 
stabilization.  By  looking  at  the  planar  case  and  by  employing  small  angle 
approximations  to  remove  nonlinearities,  the  following  equations  of  motion 


result: 


q(t)  - M^q(t)  + M^a(t)  + Mg6(t) 


a(t)  - q(t)  - L^a(t)  - Lg«(t) 


6(t)  - -X6(t)  + Xu(t) 


a(t)  = -V^(a(t)  - q(t)) 


where  M , M , M, , L , and  L,  are  stability  derivatives  and 
q a 0 a o 


(17) 


(18) 


(19) 


(20) 


1 


(21-d) 


M - ^ C 
a I Ma 

yy 


“ "Vm 


(21-e) 


where 


q » dynamic  pressure 

I “ moment  of  Inertia  about  pitch  axis 

yy 

S - lifting  surface  ^ea 

d ■ characteri^lc  length  of  the  missile 

C-,  , ■ moment  coefficients 

Mq^-'TlOt  Mo 

, C„,  - normal  force  coefficients 
Na  . No 

m ” mass  of  missile. 

The  moment  coefficients  and  normal  coefficients  vary  as  a function  of  the 
missile  Mach.  In  this  study  they  are  approximated  by  a cubic  curve  fit  of 
the  plots  for  the  appropriate  coefficients  of  a generic  missile.  In  addi- 
tion to  the  coefficients  In  Equations  (21-a)  through  (21-e),  the  coefficients 
of  zero-lift  drag,  and  coefficient  of  Induced  drag,  need  to  be 

modelled.  The  sum  of  these  terms  yields 


S " ^DO  ^DI 


where  Is  the  total  coefficient  of  drag.  This  expression  can  be  written 
In  the  equivalent  form 


where  C Is  the  coefficient  of  lift  and  K Is  equal  to  the  Inverse  of  the 

li 

partial  derivative  of  the  coefficient  of  lift  with  respect  to  the  angle 


t 


of  attack  (approximately  equal  to  the  Inverse  of  the  partial  derivative 
of  the  normal  force  coefficient  with  respect  to  the  angle  of  attack),  l.e. 


(24) 


The  small  angle  approximation  employed  above  Is  explained  later  In  this 
chapter.  Equating  the  right  sides  of  Equations  (22)^ and  (23)  and  putting 
In  the  expression  for  K yields  '' 


The  coefficient  of  lift,  Cj^,  In  the  above  expression  Is  found  by  using  the 
definition  of  lift 


L - i pSC-V^  = Ma. 
2 L m I 


(26) 


where  L Is  the  lift  developed  and  M Is  the  missile  Mach.  Recall  that  a. 

t 

Is  the  lateral  acceleration  of  the  missile.  Again  a small  angle  approxima- 
tion has  been  made.  Solving  for  C yields 


(27) 


The  coefficient  of  zero-lift  drag  Is  approximated  for  a generic  missile 
using  the  expression 


C 


DO 


2 


(28) 


22 


where  M Is  the  missile  mach  number.  Using  the  above  relationships  and  the 
definition  of  drag  force  on  the  missile,  D, 


D - i pSC„v2  (29) 

the  coefficient  block  of  Figure  1 Is  simulated  as  depicted  In  Figure  9. 

The  coefficients  are  held  constant  over  the  Individual  Integration  Intervals 
of  the  simulation  along  with  target  and  missile  veloclty/Hach.  The  remainder 
of  the  parameters  In  Equations  (27)  and  (29)  were  given  values  from  a generic 
missile. 


Figure  9.  Determination  of  Missile  Coefficients 


By  neglecting  actuator  dynamics  and  setting  the  actuator  feedback  gain, 
h^,  equal  to  zero  In  Figure  10,  the  determination  of  the  airframe  parameters 
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Figure  10.  Autopilot  Adaptive  Gain  Configuration 


t. , 


most  important  for  establishing  the  autopilot  feedback  gains  is  greatly 
simplified.  This  is  justified  when  the  actuator  response  characteristics 
are  much  faster  than  those  specified  for  the  autopilot.  This  simplifica- 
tion implies  that,  X =■  «,  and  u(t)  - 6(t)  in  Equation  (19),  and  that  the 
equations  of  motion  become 


q(t) 

a 

“m 

q 

M 

a 

q(t)' 

+ 

a(t) 

1 

-L 

a 

ct(t) 

_-^6_ 

S(t) 


(30-a) 


6(t)  = -hj^q(t)  - h2a(t)  + kv(t) 


(30-b) 


a(t)  = -V^(a(t)  - q(t)) 


(30-c) 


where  k represents  a varying  input  gain  and  v(t)  is  the  input  command 
acceleration.  By  use  of  Laplace  Transforms,  it  can  be  shown  that  the 
closed  loop  poles  are  the  roots  of 


p(s)  - s^  + 


h M.  - h,V  L.M  - (M  - L ) 
1 0 2 m 6 q q a 


(-h  -h  V )(L.M^  -MrL  ) - M - M 
X 2 m 0 3 6 a q a a 


^ ^2^6 


(31) 


Under  the  assumption  that  the  actuator  dynamics  are  negligible,  the  domi- 
nant poles  of  the  missile  response  are  those  associated  with  the  airframe 
dynamics.  For  the  second  order  model  this  response  is  determined  by  the 
damping  ratio,  C,  and  undamped  natural  frequency,  o),  in  the  relationship 
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p(s)  = s + 2Cu)s  + 0)^ 


By  equating  terms  of  like  powers  In  Equations  (31)  and  (32)  these  expressions 
can  be  solved  for  the  feedback  gains,  h^^  and  h2  as 

2 

-L  [M  - + 0)  + (2Co)  + M ) (r-^  + M ) 


,(M  - L + 0)  ) + (M  + 2^0))  (L.M 

6 ot  Lg  a q 6 


(L  - 2Cu)  - M ) + M.[L  (2C(o  - L 
6 a a a S'-  a c 


V L.[M.(M  - L + m)  + (M  + 2Cto)  (L.M  - M.L  )] 

m 6 6 a ^5  “ *1  6 a 6 a 


Finally,  by  specifying  C and  o)  and  having  the  stability  derivatives 
evaluated,  the  closed  loop  poles  of  the  autopilot  can  be  determined.  For 
this  study  5 was  set  equal  to  0.707  and  u equal  to  7.07  rad /sec.  A damp- 
ing ratio  of  .707  results  in  a minimum  settling  time  for  a second  order 
system.  In  addition,  these  values  for  the  damping  ratio  and  natural 
frequency  are  realistic  values  for  a missile  with  pitch-rate  and  accelera 
tlon  feedback.  (The  values  for  both  quantities  tend  to  be  much  lower  for 
a missile  having  no  autopilot  (Ref  12:D-3). 

To  achieve  a unity  closed  loop  autopilot  gain  (l.e.  lateral  accelera 
tlon  of  missile  equals  acceleration  commanded),  one  final  parameter,  the 
input  gain,  is  develt . »d.  Looking  at  the  steady  state  solution  for  the 

case  in  which  the  commanded  acceleration,  a , equals  one^  the  value  of  k 

c 

is  adjusted  to  make  the  lateral  acceleration,  a , equal  one.  This  gives 

K 

the  expression  for  k as 
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(35) 


, / M + L M ^ 

1/  _« «ja_ 

V\  L M.  - M L,/ 
\ o 6 a S/ 


At  this  point  the  airframe  dynamics  and  autopilot  component  blocks  have 
been  completely  specified  as  functions  of  the  appropriate  dynamic  and  design 
parameters.  Physical  systems,  however,  are  subject  to  structural  and 
Instrument  constraints.  To  account  for  these  real  world  constraints  an 
acceleration  limiter  with  a value  of  ±15  g's  Is  Included  In  the  truth 
model.  As  will  be  noted  In  the  simulation,  the  limiter  will  not  be  exer- 
cised. This  Is  true  for  this  study  only  and  would  not  be  the  case  In  cer- 
tain encounter  geometries. 

System  Noises 

This  section  models  the  random  noise  components  of  the  system  truth 
model.  As  depicted  In  Figure  1,  four  separate  random  noise  sources  are 
considered  in  the  system  truth  model:  missile  seeker  LOS  angle  noise, 

tracker  LOS  angle  noise,  range  noise,  and  range  rate  noise.  The  noise  Input 
Into  the  seeker  creates  an  error  in  the  missile  commanded  lateral  accelera- 
tion, while  the  three  measurement  noises  create  tracking  errors  In  the 
tracker  system.  It  Is  Important  to  recall  that.  In  the  case  of  the  tracker, 
perfect  tracking  Is  accomplished  by  the  servo  system.  The  noises  that 
actually  corrupt  the  four  physical  measurements  are  themselves  a complex 
mixture  of  Individual  system  disturbances.  For  the  tracker  angle,  range, 
and  range  rate  noises.  Ref  (3)  classifies  the  various  sources  of  noise 
as  radar-dependent  tracking  error,  radar-dependent  translation  errors, 
target-dependent  tracking  error,  and  propagation  error  (Ref  9:326,373, 

400).  Ref  (13),  however,  categorizes  the  noises  according  to  their 
dependency  on  mlsslle-to-target  range.  This  study  will  consider  the  noise 
types  to  fall  Into  three  categories:  "glint",  "scintillation",  and  "thermal" 
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noise.  This  approach  Is  consistent  with,  and  Includes,  the  salient  features 
of  the  references  cited  In  this  study.  A description  of  the  various  noise 
types  follow. 

"Glint" . Glint  Is  defined  In  this  study  as  angle  scintillation,  as 
opposed  to  amplitude  scintillation,  to  be  discussed  subsequently.  It  refers 
to  the  disturbances  In  apparent  angle  of  arrival  of  the  return  signal  due 
to  Interferences  (l.e.  phase  distortions).  Physically  It  represents  the 
wandering  of  the  apparent  center  of  the  radar  reflection.  As  pointed  out 
In  (Ref  1) , the  center  of  reflection  may  at  times  lie  well  outside  the 
physical  limits  of  the  target  (Ref  15:47).  The  Importance  of  glint  Is 
readily  apparent.  In  as  much  as  a large,  abrupt  variation  In  measured 
radar  angle  will  be  Interpreted  as  a change  In  angular  velocity  of  the 

■t* 

target . 

It  Is  found  that  a first  order  Gauss-Markov  process,  l.e.  the  output 
of  a first  order  lag  driven  by  white  Gaussian  noise,  provides  a good  curve 
fit  to  the  ensemble  statistics  of  the  glint  spectrum.  This  model  proves 
suitable  for  both  large,  slow  moving  and  small,  rapidly  moving  targets. 

The  modelling  difference  In  the  two  cases  lies  In  the  proper  choice  of  lag 

time  constant  and  signal  strength  of  the  Input  white  noise.  In  addition,  i 

] 

however,  glint  Is  dependent  on  both  range  and  target  aspect  angle.  In  1 

general,  glint  will  vary  Inversely  with  both  range  and  the  Instantaneous  ' 

cross  section  of  the  target.  The  effect  of  varying  aspect  ratio  Is  the 
appearance  of  large  spikes  In  the  spectral  density  at  points  of  phase  dis- 
continuities. A model  for  the  spike  characteristic  Is  developed  In  (Ref  15). 
However,  for  the  purposes  of  this  study,  the  glint  will  be  modelled  as  a j 

simple  first  order  Markov  Process.  It  will  be  assumed  that  It  Is  Inde-  ] 

pendent  of  both  range  and  aspect  angle.  This  approach  Is  taken  In  view 
of  time  and  computer  constraints.  By  assuming  a point  mass  missile,  the 
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latter  assumption  Is  reasonable.  The  range  assumption  Is  reasonable  for 
the  missile  noise  since  the  missile  seeker  Is  In  general  a passive  or 
seml-actlve  system.  In  either  case,  the  noise  can  be  Justified  as  range 
Independent  (Ref  13:A-14).  Therefore,  the  strength  of  the  Input  white 
noise  for  the  glint  model  Is  assumed  to  be  constant. 

"Scintillation" . Scintillation,  or  more  specifically  amplitude 
scintillation,  refers  to  amplitude  distortions  of  the  received  signal. 

In  general,  scintillation  Is  directly  proportional  to  range  (l.e.  decreas- 
ing slgnal-to-nolse  ratio).  For  the  ranges  considered  In  this  report,  this 
dependence  can  be  eliminated  since  the  amplitude  of  received  signal  will 
not  vary  significantly.  Two  additional  features  of  scintillation  should 
be  noted.  First,  It  Is  also  dependent  on  the  target  aspect  angle. 

Ref  (15)  states  that  the  phase  and  amplitude  distortions  due  to  aspect 
angle  are  negatively  correlated.  As  In  the  case  of  glint,  however,  this 
effect  Is  not  modelled  for  the  assumed  point  mass.  Secondly,  the  frequency 
spectrum  of  the  scintillation  can  be  assumed  to  be  Identical  to  that  of  the 
glint  spectrum  (Ref  1:290).  This  allows  for  a "lumping"  of  the  glint  and 
scintillation  spectrums  Into  one  first  order  Markov  Process. 

"Thermal" . The  final  noise  component  to  be  considered  Is  the  thermal 
noise.  This  form  of  noise  Is  generated  by  the  background  of  "black  body" 
radiation  - both  environmental  and  receiver  noise.  A good  example  of  this 
form  of  noise  Is  "shot  noise"  In  electronic  tubes.  Thermal  noise  Is  In- 
versely proportional  to  the  slgnal-to-nolse  ratio,  which  In  turn  Is  In- 
versely proportional  to  range.  It  Is  characteristically  modelled  as  a 
white  noise  over  the  bandwidth  of  the  systems  considered  (Ref  13:A-11). 

The  assiimed  model  for  this  study  Is  a white  Gaussian  noise  of  a constant 
strength.  While  this  model  neglects  the  effect  of  range  dependency.  It 
should  not  seriously  degrade  the  results  of  the  study. 
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Based  upon  the  above  descriptions  of  the  noise  types,  all  four  of  the 
system  noises  are  modelled  as  the  sum  of  an  exponentially  correlated 
Gaussian  noise  added  to  a Gaussian  white  noise.  The  correlated  portion 
of  the  noise  models  the  glint  and  scintillation  error  components  while 
the  white  noise  source  represents  the  thermal  component.  The  summing 
of  the  noise  types  to  achieve  the  total  noise  for  each  system  noise  Is 
based  upon  the  statistical  description  of  the  various  noises  as  completely 
uncorrelated  with  each  other.  It  has  been  found  In  practice  that  this 
assumption  Is  valid  (Ref  1:324).  Using  the  range  measurement  noise  as  an 
example,  each  system  noise  can  be  described  by  an  autocorrelation 


E{nj^(t)rij^(t  + t)}  - 6(t) 


(36) 


where  ~ strength  of  gllnt/sclntlllatlon  noise  corrupting  the  range 


measurement 


o^  ■ strength  of  thermal  noise  corrupting  the  range  measurement. 


Table  I lists  the  standard  deviation,  a,  and  correlation  time,  t,  for  the 
various  system  noises.  The  values  of  the  noises  are  obtained  from  a 
composite  of  figures  received  from  AFAL  and  the  values  used  In  (Ref  15) . 
The  values  of  the  Individual  seeker  noise  components  were  determined  by 
using  the  one  sigma  values  from  (Ref  5)  as  the  total  noise  strength  and 
using  the  same  ratio  of  thermal  to  gllnt/sclntlllatlon  strength  as  found 
In  the  tracker  angle  measurement  channel. 

Noise  Generator . Each  of  the  eight  components  of  noise  was  produced 


using  a call  to  Subroutine  NOISE  (see  Appendix  C) . The  essential  pro- 


cedure Is  to  generate  a unit  variance  Gaussian  noise  and  to  multiply  It ' 


by  the  strength  desired.  For  a white  noise  the  strength  Is  o , while 


i- 

4-1 
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for  an  exponentially  correlated  noise  the  strength  of  the  input  white  noise 
2 1 

is  equal  to  2Xa  where  ^ 9:345) 


Table  1 

Strengths  and  Time  Constants  for  Measurement  Noises 


MEASUREMENT 

a 

T 

e (radians) 
THERMAL 
GL/SCINT 

.003 

.000894 

6- (radians) 
THERMAL 
GL/SCINT 

.00126 

.00168 

.5 (sec) 

R-(feet) 

THERMAL 

GL/SCINT 

11.7 

10.0 

.5 (sec) 

^ (feet/sec) 
THERMAL 
GL/SCINT 

7.0 

4.242 

l(sec) 

Miss ile-Tr acker  Kinematics 

Three  reference  frames  are  used  to  describe  the  dynamics  of  the  engage- 
ment scenario.  The  first  of  these,  the  initial  missile  llne-of-sight  frame 
(IMLOS),  is  Instrumented  by  the  missile  guidance  equipment  to  accomplish 
target  Intercept.  The  second  and  third  frames  are  the  tracker  inertial 
frame  (I)  and  tracker  llne-of-sight  frame  (TLOS).  Both  the  TLOS  and  I 
frame  are  used  in  determining  tracker /missile  kinematics.  The  tracker 
measurements,  taken  in  the  TLOS  frame,  are  used  to  update  the  tracking 
filter  algorlth,  while  the  desired  outputs  of  the  filter  algorithm  are 
coordlnatlzed  in  the  I-frame.  The  motivation  for  using  two  tracker  frames 
was  given  in  Chapter  One. 

Initial  Missile  Line-of-Sight  Frame.  Both  the  motivation  for,  and 
development  of,  the  IMLOS  frame  are  well  developed  in  (Refs  5 and  13). 

Unlike  these  sources,  however,  both  the  tracker  and  missile  accelerations 


3 


and  velocities  will  be  allowed  to  vary  - the  trackers  In  an  unspecified 
manner,  and  the  missiles  as  .a  results  of'  aerodynamic  drag  affects.  The 
Intercept  geometry  Is  depicted  In  Figure  11.  The  IMLOS  frame  does  not 
rotate,  but  does  translate  with  the  missile.  It  Is  assumed  that  an  off- 
boreslght  launch  capability  Is  available.  Having  assumed  this  capability 
the  desired  missile  lead  angle,  6^,  Is  given  by 


-1  ^T 

sin  sin  0 ) 

V a 

m 


where  V and  V are  the  velocities  of  the  tracker  vehicle  and  missile 
1 m 

respectively,  and  0^  Is  the  angle  the  tracker  makes  with  IMLOS  as  depicted 
In  Figure  11.  The  angle  0 varies  as 


The  initial  target  angle,  0^,  Is  set  by  Initial  conditions  at  the 
time  of  missile  tracking  Initiation,  and  varies  according  to 


a 


where  a Is  the  tracker  acceleration  perpendicular  to  the  V vector. 
t2  t 

Both  a and  a are  defined  as  positive  In  the  direction  that  results  In 
% ^2 

an  Increasing  0^^  and  0^  respectively.  Hhlle  defining  positive  a^j^  In  this 
manner  Is  adequate  for  the  IMLOS  frame.  It  Is  not  compatible  with  the  TLOS 
frame.  This  Inconsistency  Is  easily  solved  by  a sign  change  In  the  computer 
simulation  as  will  be  discussed  later. 

The  change  In  the  relative  velocity  normal  to  the  LOS  Is 


y . - V^sln0^  - V sln0, 
d t t m I, 
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where  y.  Is  the  lateral  distance  between  the  tracker  and  missile.  Finally, 
a 

It  Is  seen  that  (referring  to  Fig  11) : 

y y 

e - tan"^(— ) a — (Al) 

*t  *t 

m m 

where  la  the  projection  of  mlsslle-to-target  range  on  the  original  line 
m 

of-slght  direction.  The  approximation  In  Equation  (Al)  la  valid  for  a 
properly  designed  guidance  scheme  (l.e.  the  case  In  which  y^,  a good 
approximation  of  miss  distance.  Is  kept  small).  Note  also  that  as  x^ 

m 

approaches  zero,  the  angle,  0,  gets  large.  This  Is  the  source  of  the 
terminal  hlgh-g  condition  so  common  to  proportional  navigation. 

Tracker  Frames . Both  reference  frames  associated  with  the  tracker 
are  depicted  In  Figure  12.  It  will  be  assumed  that  the  aircraft- 
instrumented  navigation  frame  Is  a stationary/local  Inertial  frame.  This 
will  be  valid  for  the  short  duration  of  the  engagement  scenario.  The 
choice  of  this  frame  Is  convenient  since  several  of  the  parameters  that 
are  required  In  filter  Implementation  are  available  from  the  Instruments 
required  to  mechanize  the  frame.  Among  these  are  rate-integrating  gyros 
on  the  antenna  axis  and  accelerometers  on  the  platform.  From  Figure  12 
It  Is  readily  seen  that  the  direction  cosine  matrix  for  transforming  from 
the  I to  the  TLOS  frame 

cos9^  slnG^  0 

slnG^  cosG^  0 (A2) 

0 0 1 

TLOS 

The  antenna  centerline  Is  defined  as  the  x axis.  It  Is  assumed  that 
the  tracker  Is  capable  of  Instantaneous,  errorless  response  to  commanded 
signals  (l.e.  errors  In  G are  due  only  to  errors  In  system  measurements). 


Missile-Tracker  Engagement  Geometry 


I This  simplification  reduces  system  complexity  while  still  allowing  analysis 

i 

of  the  dominant  features  of  the  missile  motion. 

Missile  Kinematics.  By  utilizing  the  piecewise  continuous  assumption, 
very  simple  kinematic  relations  can  be  established.  Significantly,  missile 
behavior  Is  well  enough  behaved  that,  despite  using  this  assumption,  rela- 
tively sophisticated  models  can  be  used  for  missile  dynamics,  parameters, 
and  coefficients.  Figure  12  Illustrates  the  engagement  geometry.  The 
components  of  the  Inertlally  referenced  missile  velocity  are  given  by 


mx 


X ■ V slny 
m m m 


(43-a) 


my 


y ■ V COSY 
m m m 


(43-b) 


n 


where 

“X  and  y components  respectively  of  missile  velocity  In  I 

nx  my 

frame 

x^,  y^  ■ X and  y position  of  missile  In  I frame 
mm 

y - 

m 

my 

This  convention  will  hold  throughout  the  remainder  of  this  study.  To 
develop  the  missile  acceleration  It  Is  necessary  to  examine  certain  aero- 
dynamic quantities. 

Figure  13  Is  a free  body  diagram  of  the  non-thrusting  missile.  The 
forces  acting  on  the  missile  are  lift  and  drag.  It  Is  assumed  that  the 
velocity  of  the  missile  Is  aligned  with  the  longitudinal  axis  of  the 
missile.  Therefore,  by  definition,  the  drag  will  be  along  the  longitudinal 
axis  of  the  missile  and  opposite  In  direction  to  the  velocity.  It  follows 
that  the  missile  lift  force  Is  normal  to  the  longitudinal  axis.  These 
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Figure  13.  Missile  Free  Body  Diagram 


assumptions  Imply  that  the  angle-of-attack,  a,  of  the  missile  is  zero. 
This  will  not  be  true  In  the  presence  of  missile  deceleration  and/or 
maneuvering.  However,  due  to  a combination  of  high  airspeeds  and 
structural  g-llmitatlons,  missiles  are  generally  designed  for  angles- 
of-attack  of  less  than  five  degrees.  For  the  Mach  range  considered  In 
this  study,  a small  angle  approximation  Is  valid.  Using  the  definitions 
listed  In  Equations  (26)  and  (29)  it  follows  directly  that  the  accelera- 
tions due  to  drag  and  lift  are  given  by 

“d  ■ I 

and 


L- 


From  Figure  13  It  can  be  seen  that 


I 

a 

mx 


COSY  * a.  - slny  • 
ml  ml) 


and 


(46-a) 


I 

a 

my 


-slny 

m 


^ - cosY^ 


(46-b) 


where  a^  and  a^  represent  the  x and  y-acceleratlons  respectively  of  the 
mx  my 

missile  coordlnatlzed  In  the  I frame.  Equations  (46-a)  and  (46-b)  utilize 
a positive  a^j^  as  depicted  In  Figure  13.  The  sense  of  the  a^  vector  Is 

correct  since  a missile  acceleration  In  the  direction  depicted  creates  a 

• 

positive  rate  of  change  of  the  TLOS  angle,  l.e.,+0^.  Note,  however,  that 

In  the  IMLOS  frame  Is  positive  In  the  opposite  direction.  The  sign 

difference  Is  compensated  for  by  commanding  the  missile  with  a minus  times 

the  rate  of  change  of  the  TLOS  angle.  Finally,  from  Equations  (42),  (46-a) 

and  (46-b),  It  Is  seen  that  the  missile  acceleration  along  the  Instantaneous 

TLOS 

mlsslle-to-tracker  LOS,  a , can  be  represented  by 


TLOS 

a 

mx 


cos0_a^  + sln0„a^ 

T mx  T my 


(47-a; 


or 


TLOS 

a 

mx 


cos0^(cosY^a^-8lny^ap) 


+ sln0_(-siny  a,  - co8y„a_) 


(47-b 


Tracker  Kinematics . The  motion  of  the  tracker  aircraft  Is  described 
by  a set  of  closed  form  equations.  The  actual  motion  of  a target  aircraft 
would.  In  general,  be  best  described  by  a random  process.  The  chosen 
mathematical  description,  however.  Is  generic  In  nature  and  does  allow 
for  several  Important  types  of  evasive  aircraft  maneuvers  such  as  high  *'g" 
turns  or  "jinking"  maneuvers.  It  Is  assumed  that  the  tracker  Is  located 
on  the  target  aircraft.  This  assumption  Is  required  since  the  tracker 
could  be  carried  on  a remote  "area  defense"  vehicle.  The  tracker  position 
equations  are 


I 

*T 


Kj^t  + K^cosut 


K-t  + K,  slniDt 
3 A 


(48-a) 


(A8-b) 


where 

x^,  y^  «•  X and  y positions  of  tracker  In  I frame 
K^,  K2,  Kj,  K^  ■ chosen  constants 
a»  “ tracker  rate  of  rotation. 

It  follows  from  successive  differentiations  that 


^ “ K^uslnojt 


(49-a) 


^Ty  “ ^3 


(49-b) 


t . 


and 


a^  ” -K2U)  cosut 


(50-a) 


^ >.C. 
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aiL  “ -K.oj^slnut 
Ty  4 


(50-b) 


where  and  are  the  x and  y-veloclty  components  of  the  tracker  and 
a^^  and  a^  the  x and  y-acceleratlon  components  of  the  tracker.  Finally 
from  Equations  (42) , (50-a) , and  (50-b)  It  Is  seen  that 


TLOS 

Tx 


2 2 
cos0^(-K2(o  coBUt)  + sln0^(-K^(jj  slnut) 


(51) 


Relative  Kinematics.  The  use  of  three  reference  frames  requires  the 
transformation  of  missile  accelerations  Into  the  TLOS  frame  and  Into  the  I 
frame.  One  additional  transformation,  not  previously  discussed.  Is  required 
to  transform  tracker  acceleration  Into  a tracker  body  frame  In  order  to 
determine  a^  In  Equation  (39) . Prior  to  establishing  this  additional 
transformation,  however,  the  set  of  angles  that  describe  the  relationships 
between  various  system  frames  and  vectors  quantities,  as  depicted  In 
Figures  12  and  14,  are  listed: 


- 90  - sln"^(V^/V^) 
0^  - 270*  - LOA 

0Q  - 270*  - LOA(O) 

*0-  0-Y;-e^(O) 

- 360*  - 0 

1 a 


(52-a) 


(52-b) 


(52-c) 


(52-d) 


(52-e) 


(52-f) 
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Figure  14.  TLOS  to  Tracker  Body  Frame  Transformation 

The  angles  defined  In  Equations  (52-a)  through  (52-g)  restrain  the  initial 

conditions  of  the  simulation.  With  the  I frame  centered  at  the  target  at 

time  equal  to  zero,  the  missile  initial  position  must  lie  in  the  third 

quadrant,  (l.e.  both  and  must  be  less  than  or  equal  to  zero),  as 

mm 

in  Figure  15.  Though  appearing  restrictive,  the  initial  conditions  allow 
for  all  engagements  from  head-on  attacks  to  tail  attacks  and  all  angles 
between.  This  is  achieved  by  either  varying  initial  position  in  the 
third  quadrant  and/or  initial  tracker  heading. 

The  angle  is  used  in  the  transformation  of  the  tracker  accelera- 
tion in  the  TLOS  frame  into  the  tracker  body  frame 


1 


Figure  15.  Truth  Model  Position  Initial  Conditions 


,TB 

"TLOS 


COS((l^ 

-SllKp. 


sincjij^  0 

cos^j^  0 


(53) 


from  which  It  is  seen 


TB  . . TLOS  , TLOS 

^ “ -^Ty  ‘ 


(54) 


r i 


This  relationship  Is  depicted  In  Figure  14.  Note  that  the  x-axis  of  the 

tracker  body  frame  is  aligned  with  the  tracker  velocity. 

The  missile  inertial  quantities  were  obtained  by  generating  a^^  and 

a^j  and  then  resolving  them  into  inertial  coordinates  using  the  angle  the 

missile  velocity  vector  makes  with  the  inertial  y-axis,  y • With  both 

n 

tracker  and  missile  kinematics  in  the  Inertial  frame,  it  can  be  seen  from 
Figure  12  that  the  range  equals 
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1 

*■  (55) 

Range  rate  Is  defined  as  the  relative  velocity  along  the  Instantaneous 
llne-of-slght 

- -R  (56) 

or  expressed  differently 

V - (vi_  - )slnLOA  + (V^_  - )cosLOA  (57) 

c xT  xm  yT  ym  ' ' 

A complete  listing  and  sequencing  of  the  various  transformations  can  be 
found  In  the  computer  flowchart  and  listing  In  Appendix  C. 

System  Equations 

This  section  develops  the  equations  of  the  missile  airframe,  auto- 
pilot, and  dynamics.  The  state  space  format  Is  used  for  these  equations, 
but  no  attempt  Is  made  to  describe  the  whole  of  the  truth  model  In  a state 
space  representation.  There  are  fourteen  equations  developed  - the  first 
twelve  of  which  are  developed  In  (Ref  5)  and  are  repeated  here  only  for 
completeness.  The  section  ends  with  a listing  of  those  quantities  to  be 
estimated  by  the  Kalman  filters. 

Prior  to  developing  the  equations.  It  Is  convenient  to  define  the 
states  and  the  several  quantities  used  In  the  development.  Definitions 
of  several  of  these  quantities  can  be  found  elsewhere  In  the  study,  but 
are  repeated  here  for  clarity.  The  14  states  are 
Xj^  ■ y^,  mlsslle-to-target  lateral  distance 
x^  ~ missile  lead  angle 
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" — * reciprocal  of  misslle-to-target  range 

X.  6 , angle  between  missile  centerline  and  nonrotating  reference 
4 m 


X,  ■ 6 , missile  pitch  rate 
j n 

Xg  ” a^,  missile  lateral  acceleration 

Xy  ■ 6,  elevator  deflection 

X-  ~ a , missile  commanded  acceleration 
o c 

Xg  ” e'  - 0',  defined  state,  where  e*  ” boreslght  error  signal  and 

6*  - measured  LOS  angle 

Xj^Q  * 0^,  tracker  angle  wrt  IMLOS 

Xj^j^  “ a^,  tracker  acceleration  normal  to  IMLOS 

Xj^2  “ missile  seeker  noise 
XMLOS 

*13  " ^mx  ’ *~''^®^ocity  component  of  missile  In  IMLOS  frame 
XMLOS 

X-,  “ V , y-veloclty  component  of  missile  In  IMLOS  frame 
14  my 


In  addition 


hj^,  h2  “ autopilot  feedback  gains 

V /V^  * missile/tracker  velocity 
m t 

K ■ autopilot  Input  gain 

k^  ■ aberration  error  slope 

M , M.,  M , L , L,  ■ stability  derivatives 
a 6 q a 0 

q(t)  ■ pitch  rate 
l/\  ■ actuator  time  constant 
■ track  loop  time  constant 
T2  * guidance  loop  time  constant 
0*  ” measured  LOS  angle 
6^  " filtered  LOS  angle 
u(t)  ■ Input  to  autopilot 
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The  equations  for  and  x^  are  derived  directly  from  Equations  (38) 
and  (40) 


X,  “ V^slnx,-  - V slnx. 
X t XU  n z 

*2  " 


(58) 


(59 


The  "g"  In  Equation  (59)  Is  present  since  all  accelerations  In  these  equa- 
tions are  In  terms  of  g's.  The  third  "state  variable"  equation  Is 


• 1 • 2 • 

X-  T ® ■"  “*•»  ® 

R ^ 


But  using  Equation  (56)  this  can  be  written  as 


(6o: 


V 

c 


(6i; 


In  Equation  (61),  Is  considered  a positive  quantity.  The  equation 

for  X,  Is 
4 


(62: 


The  equation  for  x^  Is  developed  by  utilizing  the  expression 


+ L.6(t)) 

St,  m a 0 


(63) 


for  acceleration.  Solving  for  the  angle  of  attack 


a (t)  - V L 6(t) 

«<t)  ■ 1^. - 


V L 
m a 


(64) 
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and  substituting  this  expression  into  Equation  (17)  and  recognizing 
q(t)  “8  ■ X-,  the  result  is 

qM  L- 

x_  ■ M X.  + X,  + (M.  - — M )x_  (65) 

5 q 5 6 6 o 7 

The  next  equation  is  developed  by  taking  the  derivatives  of  Equation  (62) 
and  substituting  in  for  a(t)  from  Equation  (18)  and  a(t)  from  Equation  (6A) 


- v/t)  - XV^LjS(t)  + XV„LjU(t) 


Finally,  from  Figure  10,  u(t)  can  be  seen  to  be 


u(t)  » -h^q(t)  - h23j^(t)  + Ka^Cb) 


therefore 


X,  » - (V  L - h.XV  L-)x.  - (L  + h,XV  L )x 
6 g ma  lmo5  a Zmoo 


- - XV  L,x_  + XV  L,Kx- 
g m 6 7 moo 


The  equation  for  x^  comes  from  Equations  (19)  and  (67)  which  yield 


x^  ■ -hj^Xxj  - gk2^*6  ” ^*7  ^ 


From  Figure  6,  the  transfer  function  of  a^/0'  can  be  written 


a nV 

-4  . _£ 

i’  1 + 


therefore 


The  relationship  for  0*  can  be  derived  from  Equation  (15) 


0’  - Tj^0’  + 0^ 


The  expression  for  x^  Is  then  described  as 


and  this  yields 
*9  - -^l®f  ' 

Note  that  Tj^0 ^ Is  the  boreslght  error  from  Equation  (11) . By  putting 

e 

the  expression  for  x^  In  Equation  (74)  and  rearranging  terms 
but  from  Figure  5 It  can  be  seen  that 


0'  - + (1  + 

putting  this  Into  Equation  (75)  yields 

*o  “ ^ (k  X.  - X.  - X,,  - (1  + k^)x,x-} 


Putting  this  expression  x„,  with  a minus  sign,  back  Into  Equation  (71) 


gives 


L — X/  “ ■ *-10  ■ k )x.X_>  - — Xr 

8 ^ ^ rl3  ^2  ° 


The  equation  for  x-«  Is 


10 


where  Xj^j^,  a^.  Is  described  as 


TB  TLOS 
*11  " ^TLOS  ®T 


where  a^°^  Is  the  total  tracker  acceleration  vector  In  the  TLOS  frame. 


The  expression  for  Xj^j^  Is 


• „TB  -TLOS  •! 
*11  “ ^TLOS  ®T 


where  ^ can  be  expressed  In  a closed  form  equation.  In  the  actual  simu- 
lation, the  rectangular  Integration  scheme  made  It  unnecessary  to  use 
The  expression  for  Xj^2  seen  to  be 

*12  " ”^*12  ^ '^1  * '^2 


where  and  rij  white  Gaussian  noises  of  appropriate  strengths. 
Finally,  from  Figure  11,  Xj^^  and  x^^^  are  seen  to  be 


- (cos0j^  • Sjj  + sln0^  • Xg)g 


(84) 


*14  " 

Recall  that  a^^  is  the  acceleration  due  to  drag,  computed  In  Equation  (44). 

A total  of  ten  truth  model  parameters  are  to  be  estimated  by  the  two 
Extended  Kalman  Filters.  These  truth  model  quantities  are  defined  as  "true 
states"  and  are  to  be  compared  to  the  filter  state  estimates.  The  first 
five  true  states  are  common  to  both  filters 


TS(1) 

* 6 

(85-a) 

TS(2) 

- 

mx 

(85-b) 

TS(3) 

- 

my 

(85-c) 

TS(4) 

- R 

(85-d) 

TS(5) 

e 

- R 

(85-e) 

For  the  "Landau  Filter"  the  last  three  states  are 


TS(6)  - 

mx 

(86-a) 

TS(7)  - a^ 
mx 

(86-b) 

TS(8)  - a^ 
my 

(86-c) 

For  the  "Landau  Filter",  Chapter  Three  shows  that,  in  the  planar  case,  not 
all  eight  of  the  states  are  Independent.  Further  discussion  of  this  Is 
deferred  to  Chapter  Three.  For  the  "Unknown  Parameter  Filter",  the  final 
two  states  are 


TS(6)  - n 

(87-a) 

TS(7)  - m/s 

(87-b) 
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where  n is  the  proportional  navigation  constant  and  m/S  Is  the  ratio  of 
the  missile  mass  to  the  reference  surface  area. 

Summary.  Chapter  Two  has  developed  the  real  world  model  of  the 
engagement  scenario's  systems,  parameters,  and  noises.  By  utilizing  a 
piecewise  continuous  assumption.  It  has  been  possible  to  describe  a complex, 
nonlinear  system  and  yet  simulate  the  system  using  a simple  rectangular 
Integration  scheme.  The  modelling  emphasis  has  been  on  the  missile  system 
and  Its  associated  parameters  and  coefficients. 

The  system  equations  were  developed  throughout  the  chapter.  The  truth 
model  flowchart  and  computer  listing  are  In  Appendix  C and  are  labeled 
subroutine  TRAJ.  Finally,  the  "true  states"  were  generated  for  the  Mbnte- 
Carlo  analysis  of  the  two  filters. 
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III.  Extended  Kalman  Filter 


Introduction 

This  section  presents  the  Extended  Kalman  Filter  equations  and 
develops  the  "Landau"  and  "Unknown  Parameter"  Filters.  As  will  be  seen, 
both  of  these  filters  are  highly  nonlinear.  Therefore,  the  conventional 
Kalman  Filter  Is  not  an  appropriate  estimator  for  this  particular  system. 
The  Extended  Kalman  Filter  (EKF)^  however.  Is  a good  Initial  choice  as  a 
means  of  solving  the  nonlinear  system  estimation  and  prediction  problem. 
The  EKF  gain  and  covariance  propagation  equations  have  the  same  form  as 
the  Kalman  Filter  equations,  but  are  linearized  about  the  current  state 
estimates.  The  linearization  Is  a first  term  approximation  to  a Taylor 
series  expansion  about  the  current  state  estimate.  Higher  order,  more 
exact  approximations  to  the  optimal  nonlinear  filter  can  be  achieved  by 
using  more  terms  of  the  Taylor  series  expansion  for  the  nonllnearltles, 
and  by  deriving  recursive  relations  for  the  higher  order  moments  of  the 
state  vector,  x (Ref  4:184,  Ref  9:252).  When  compared  to  the  EKF,  how- 
ever, the  higher  order  filters  are  both  more  complex  and  more  costly  In 
terms  of  computer  Implementation.  The  higher  order  filters  are  not  con- 
sidered In  this  thesis.  In  general,  when  nonllnearltles  are  significant, 
neglecting  the  higher  order  terms  results  In  biased  estimates. 

It  Is  Important,  therefore,  to  remember  that  the  system  model  within 
the  EKF  Is  an  approximation  to  the  actual  nonlinear  system.  The  fact  that 
It  Is  an  approximation  Implies  that  the  filter's  predictions  and  estimates 
will  be  limited  by  the  "correctness"  of  the  system  modelling  assumptions. 
More  specifically,  large  differences  between  an  assumed  nominal  trajectory 
and  the  true  trajectory  can  result  In  loss  of  tracking  accuracy,  or  loss 
of  track  completely.  In  general,  the  greater  the  system  nonllnearltles, 
the  poorer  the  EKF  performance.  Not  only  might  the  degree  of  nonlinearity 
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prove  the  EKF  to  be  an  Inadequate  filter  form,  it  also  creates  a filter 
( design  disadvantage  for  the  EKF  - and  higher  order  filters.  Unlike  the 

conventional  Kalman  filter,  the  EKF  gains  and  estimation  error  covariance 

A 

matrices  depend  on  the  time  history  of  3c(t),  l.e.  estimation  accuracy  is 
trajectory  dependent  (Ref  4:187).  This  requires  that  the  actual  filter 
performance  be  verified  by  a Monte-Carlo  simulation.  In  general,  this 
form  of  analysis  Is  both  more  time  consuming  and  more  costly  In  terms  of 
computer  usage  than  Is  a covariance  analysis.  Despite  these  factors,  the 
EKF  has  been  used,  and  has  been  found  to  yield  accurate  estimates.  In  a 
number  of  Important  applications.  An  example  which  Includes  parameter 
estimation  can  be  found  in  (Ref  9)  (Ref  9:189).  The  derivation  of  the 
EKF  equations  Is  not  Included  in  this  thesis.  Instead  the  equations  are 
stated,  and  (Refs  4 and  9)  are  given  as  sources  for  the  filter  derivation. 

^ - Equations  and  Explanation 

The  equations  for  the  EKF  can  be  divided  into  three  categories: 
system  equations  upon  which  the  filter  Is  based,  propagation  equations, 
and  update  equations.  The  system  equations  can  be  expressed  In  the  form 


x(t)  - flx(t),u(t),t]  + G(t)w(t)  (88) 

where  w(t)  Is  a zero  mean  white  Gaussian  noise  process  of  strength  ^(t), 
l.e. 


E{w(t)w^(t+T)}  - Q(t)6(T)  (89) 


and  where  x(t  ) Is  modelled  as  a Gaussian  random  variable  with  mean  x and 
— o ~o 

covariance  P . In  Equation  (88),  u(t)  represents  a deterministic  forcing 
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function.  Note  that  the  dynamic  driving  noise  Is  assumed  to  enter  In  a 
linear  additive  fashion  (Ref  9s 179),  In  addition,  the  discrete  measure— 
ment  equations  can  be  expressed  as 

^(t^)  - h[x(t^),tj^]  + v(t^)  (90) 

where  ® white  Gaussian  noise  sequence  of  zero  mean  and  covariance 

kernel 

E{v(tjj^)v^ (tj  ) } - (91) 

E(tj^)  represents  the  strength  of  the  v(t^)  noise  process.  It  Is  assumed 
that  w(t^)  and  v(t^^)  are  Independent  of  each  other.  The  specific  system 
equations  for  the  "Landau"  and  "Unknown  Parameter"  Filters  are  developed 
later  In  this  chapter. 

The  filter  propagation  equations  are 

i(t/t^)  - f[x(t/t^),u(t),t];  x(t^/t^)  » x(t^)  (92) 

where  the  notation  ^(t/t^^)  means  the  optimal  estimate  of  the  state,  x, 
at  time,  t,  given  the  updated  estimates  up  to  and  Including  time  t^^.  In 
addition,  (the  covariance  Is  propagated  approximately  by) 

P(t/t^)  - F[t;x'*‘(t^)]P(t/t^)  + P(t/t^)F[t;x‘^(t^)]’^ 

+ G(t)a(t)G(tf;P(t^/t^)  - P(t^)  (93) 
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where  £ Is  the  filter  covariance  matrix  and  £ Is  the  matrix  of  partial 
derivatives  of  ^ with  respect  to  x,  evaluated  along  the  nominal  trajectory 


F[t;x^(tj)l 


3^[x(t),u(t),t] 


9x 


x(t) 


(94) 


The  notation  [t;jc  (t^^)]  Implies  that  the  linearized  F matrix  Is  evaluated 
at  the  values  of  the  states  just  after  a measurement  update  (Ref  7:19,20). 
This  la  an  approximation  to  the  actual  EKF  equation  In  which  the  value 
elements  are  evaluated  as  a function  of  x(t/t^)  for  all  te[t^,t^^j^) . 

Since  the  measurement  update  period  for  this  problem  Is  one-flftleth  of 
a second,  this  should  be  a good  approximation  (l.e.  the  value  of  the  states 
remain  relatively  unchanged  over  the  period).  This  assumption  helps  to 
reduce  computer  simulation  time.  Note  that  the  dependency  of  the 
covariance  propagation  on  the  current  state  estimate  can  be  seen  In 
Equation  (93) . 

The  requirement  for  the  current  state  estimate  Is  also  evident  in 
the  covariance  update  equation.  The  measurement  update  is  given  by 


K(tp  = P(t~)H'^[t;x(t')HH[t^;x(t‘)]P(t")H'^[t^;x(t")]  +R(t^)}"^  (95) 


x(tp  - x(t")  + K(t^)[l^  - h[x(t“),t^]] 


(96) 


P(t^)  - P(t‘)  - K(tpH[t;i(t‘)]P(t") 


(97) 


where 


K(t.)  - Extended  Kalman  gain  matrix 


R(t^)  ■ measurement  noise  covariance  matrix  (see  Equation  (91)) 
H[t;x(t.)  ■ matrix  of  partial  derivatives  of  h with  respect  to  x 


= values  of  actual  measurements  taken  at  time  t^. 

The  notation  t^  Implies  the  value  of  the  quantity  at  the  Instant  prior 
to  the  update  at  time  t^,  and  t^  is  the  value  of  the  quantity  just  after 
the  update.  The  notation  used  thus  far,  except  as  noted  for  the  F matrix. 
Is  developed  and  used  In  (Ref  9) . The  system  equations  for  this  thesis  are 
developed  In  the  next  two  sections.  Together  with  the  propagation  and  up- 
date equations  listed  In  this  section  and  evaluated  at  the  proper  values, 
the  Extended  Kalman  Filters  are  developed.  The  m-vector  function,  h,  for 
both  filters  Is  linear.  The  F matrices  of  partial  derivatives  for  the  two 
filters  are  found  In  Appendix  A. 


"Landau  Filter" 

In  his  paper,  "Radar  Tracking  of  Airborne  Targets",  (Ref  6),  M.  I. 
Landau  deals  with  several  of  the  problems  that  are  basic  to  this  study. 
Despite  the  fact  that  Landau  considers  the  single  target  track  environ- 
ment, the  resulting  algorithm  should  be  applicable  to  the  multiple  target 
environment.  The  filter  system  equations  developed  in  Landau's  paper 
are  combined  and  modified.  In  accordance  with  the  assumptions  made  in 
Chapter  Two,  to  form  the  system  equations  for  an  Extended  Kalman  Filter. 
This  filter  is  termed  the  "Landau  Filter"  of  L-Fllter,  and  serves  as  a 
benchmark  with  which  to  compare  the  "Unknown  Parameter  Filter". 

The  L-Fllter  estimates  the  missile  attitude  direction  cosine  (A) , 

velocity  (V  ) , and  acceleration  (a  ) vectors  In  stabillzed/"inertlal" 
m m 

(I)  coordinates.  The  equations  defining  the  missile  kinematics  are 


. (V  - V ) 

; R , , ma  Ta^ 

/[  m - — + 

a R a R 


(98-a) 
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(98-b) 


•I  II. 

a =•  - — a + w 
ma  T ma  a 

a 


(98-c) 


where 


a * a subscript  that  assumes  the  values  of  x for  north,  y for  east, 
and  z for  down 

direction  cosine  in  the  a direction  (e.g.,  “ A^jR,  R = range 

from  missile  to  tracker) 

>*  correlation  time  of  acceleration  process 
w^  “ white  Gaussian  driving  noise  for  the  acceleration  process 
R > range  rate  along  the  Instantaneous  LOS  between  missile  and 
tracker 

■ a-component  of  tracker /ownship  velocity  coordinatized  in  the 
I frame. 

The  basic  observation  for  this  configuration  is 


A . = A + n. 

aobs  a Aa 


where  is  the  white  Gaussian  noise  corrupting  the  A^  observation. 
Notice  that  the  acceleration  for  this  system  of  equations  is  modelled 
by  the  first  order  Markov  Process  of  Equation  (98-c) . The  range  and 
range  rate  terms  in  Equation  (98-a)  are  supplied  as  "aiding  terms"  from 
a separate  range  and  range  rate  tracking  algorithm.  Landau  uses  this 
technique  to  maintain  the  linear  properties  of  the  tracking  algorithm 
for  simpler  mechanization.  The  equations  for  the  range  (R)  and  range 
rate  (R)  kinematics  are  expressed  in  the  LOS  coordinates  as 


R * V 


(100-a) 
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• 2_  . TLOS  TLOS 

V “uR  + a -a„ 
c mx  Tx 


1 TLOS  ^ 

a + w 

T3  mx  ^3 


where 


2 2^2 
W “ + “to 

LSy  LSz 


<0,  _ , (0  • missile  to  tracker  llne-of-slght  rates  about  the  y and 

Lby  LSz 

z LOS  coordinates 

TLOS 

a = missile  acceleration  along  the  LOS  coordlnatlzed  in  the  TLOS 
mx  ° 

frame 

TLOS 

a •“  tracker  acceleration  along  the  line-of-slght  coordlnatlzed 
in  the  TLOS  frame 

” correlation  time  of  missile  acceleration  process 
” white  Gaussian  driving  noise  for  the  acceleration  process 
“ relative  closing  velocity  between  missile  and  tracker  along  the 
instantaneous  LOS. 

Again  the  acceleration  has  been  modelled  as  a first  order  Markov  Process. 

Note  also  that  Equations  (98-a)  and  (lOO-b)  contain  tracker  kinematic 

terms.  Assuming  perfect  measurements  of  these  terms  (reference  Chapter 
I TLOS 

Two),  and  a.j,^  are  treated  as  deterministic  forcing  functions.  The 
observations  for  the  range  and  range  rate  configuration  are 


R + n. 


'ob. 
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where  and  are  white  Gaussian  noise  terms  (reference  Equation  (91)) 
that  corrupt  the  range  and  range  rate  measurements  respectively.  Landau's 
development  Is  for  a three  dimensional  problem.  For  the  planar  case, 
and  by  combining  the  two  separate  sets  of  equations,  the  following  sys- 
tem of  equations  result 


-e^sine^ 
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R ■ mx  Tx 

R + R 
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mx  mx 
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my  my 


R - V 


V “ 0_  R + a - a„ 
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•TLOS  1 TLOS  ^ 

a »■  — — a + w« 
mx  “^3  3 


1 I 
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X 


•I  11^ 

®y  Ty  my  ''y 


where  0^  Is  the  LOS  angle  as  measured  by  the  tracker  (reference  Figure  12) . 
It  Is  apparent  that  the  sln0^  and  cos0^  are  not  Independent.  Therefore, 

0^  Is  chosen  as  the  state  variable  to  avoid  observability  problems.  In 
addition  0^  can  be  generated  as  a solution  to 
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L - I cote^  + CSC0, 

T R T R T 


(lOA-a) 


. 

. I tane,  + -22—^ 
R T R 


(104-b) 


Either  of  the  two  forms  is  correct.  To  prevent  0^  from  growing  unbounded. 
Equation  (104-a)  is  used  when  sin0^  ^ .707  and  Equation  (104-b)  is  used 
when  sln0^  < .707.  Furthermore,  It  can  be  seen  from  Equations  (104-a) 
and  (104-b)  that  and  are  not  independent.  By  setting  the  two 

• T 

expressions  for  0_  equal  to  each  other  and  solving  for  V 

T my 


(Rcos^e  + vJ^eosO  - V^cos0  ) . 

V ^ ^ ^Ty 


(105-a)' 


Equation  (105-a)  is  used  when  the  sin0^  ^ .707  and 

(Rsln^0  + vl^8ln0  - V^sin0_)  . _ 

vL — ^ — — + RCOS0,  + 

mx  cos0^  T Tx 


(105-b) 


is  used  for  sln6^  < .707.  The  use  of  either  Equation  (105-a)  or  (105-b) 

eliminates  the  requirement  to  estimate  a^  or  a^  respectively.  By  setting 

my  mx 


X,  - V 

2 mx 

X-  - V 

3 my 

X,  ■ R 
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X-  ■ a 
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(106-a-h) 


and  considering  the  case  of  sln0^  ^ .707,  the  system  equations  for  the 
L-Fllter  are 
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*5^^^  ^Tx  ■ 

Xi(t)  - fj^r*(t),u(t),t]  - cotXj^(t)  + ■■■^  cscXj^(t)  (107) 


“ Xy(t) 


(108) 


x,(t)  “ f_[x(t),u(t),t]  “ 0 (V  is  not  estimated  for 
j j my 

slnS^  ^ .707  - reference 
Equation  (105-a)) 


(109) 


x^Ct)  ■ f^[x(t),u(t),t]  - Xj(t) 


(110) 


x^(t)  - fg[x(t),u(t),t]  - (Xj^)  x^(t)  + Xg(t)  - aj 


(111) 


= fg[x(t),u(t),t]  + Wj(t)  - — Xg(t)  + W3 


(112) 


X,(t)  - f^[x(t),u(t),t]  + W (t)  “ — x_  + w 
• • X T / X 


(113) 


Xg(t)  ■ fg[x(t) ,u(t) ,t]  “ 0 (a  Is  not  estimated  for 


sln0^  > .707) 


When  sln6.|,  < .707 


(114) 


(115) 


*3(t)  ■ f3[x(t),u(t),t]  - Xg(t) 


(116) 


x^(t)  - f^[x(t),u(t),t]  - 0 


(117) 


Xa(t) 


fg[x(t),u(t),t]  + w (t)  - 


X-  + w 

Ty  8 y 


(118) 


i 

s 

i 

f 


f. 


■i 

V 


All  other  equations  remain  unchanged.  In  the  equation  for  x^(t)  the 

expression  for  x^(t)  Is  considered  a parameter.  This  approximation  Is 

made  to  reduce  the  number  of  partlals  required  in  the  F matrix.  It 

assumes  that  6^  remains  constant  over  the  propagation  period.  With  the 

frequency  of  updates,  .02  seconds,  this  should  be  a good  approximation. 

It  Is  a better  approximation  at  long  and  Intermediate  ranges  to  the 

target  than  at  short  range.  All  of  the  original  set  of  equations  from 

Landau's  paper  are  easily  understood  with  the  possible  exceptions  of 

Equations  (107)  and  (111).  These  two  equations  are  developed  In  Appendix 

A.  In  addition  to  these  and  the  F matrix  development,  the  values  for  the 

6,  H,  0,  R,  X , and  P matrices  are  given  In  Appendix  A. 

— — — — o — o 

The  L-Filter  system  equations  are  clearly  a set  of  coupled,  non- 
linear differential  equations.  The  "forcing  functions"  are  the  driving 
noises  of  the  first  order  Markov  Processes  for  missile  acceleration  and 
the  tracker's  velocity  and  acceleration.  While  this  filter  adequately 
models  the  missile  kinematics.  It  does  not  utilize  some  Important 
knowledge  that  Is  available  from  the  total  system  model. 
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"Unknown  Parameter  Filter" 

The  Unknown  Parameter  Filter,  UP-Fllter,  is  so  named  since  it 
Incorporates  the  dynamics  and  coefficients  represented  In  Equations  (2) 
and  (3).  Specifically,  the  three  unknown  parameters,  C^,  and  n, 

must  be  estimated  or  modelled  to  describe  the  acceleration  of  the  missile 
as  the  sum  of  the  acceleration  due  to  drag  and  acceleration  due  to  lift. 
As  discussed  previously,  the  Inertial  acceleration  can  be  described  by 
resolving  the  a^  and  a^  vectors  of  Figure  13  Into  the  x^  and  y^  axes. 
Equations  (46-a)  and  (46-b)  are  repeated  for  convenience. 
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■ +C08Y  • a , - slny  * a_ 
mx  m t,  mu 

a^  ” -slnY  * a „ - cosy  ‘ a_ 
my  m X,  mu 


(46-a) 

(46-b) 


Equations  (46-a)  and  (46-b)  are  the  necessary  expressions  required  to 
describe  the  rate  of  change  of  velocity  In  the  Inertial  coordinate 
frame.  To  solve  for  these  quantities,  expressions  are  necessary  for  a 
and  a^.  Equations  (44)  and  (2)  are  repeated  here  for  these  quantities 


•b  - I 


(44) 


a,  “ nV  0 
1 c 


(2) 


Unfortunately,  the  values  of  n,  m,  S,  , and  C are  not  known  aprlorl 
by  the  tracking  filter.  What  Information  that  Is  available  would  be 
known  from  Intelligence  Information  on  possible  threats.  At  best  this 
form  of  Information  can  only  be  considered  relatively  accurate.  There- 
fore, to  Implement  a tracker  mechanization  utilizing  the  dynamics  of 
the  missile,  as  described  by  Equations  (46-a)  and  (46-b),  estimates  of 
the  parameters  must  be  made.  As  will  be  seen  In  the  subsequent  develop- 
ment, both  the  parameters  themselves  and  the  way  they  enter  the  state 
equations  Introduce  further  nonllnearltles  Into  the  system. 

As  stated  In  Chapter  Two,  the  proportional  navigation  constant,  n. 

Is  considered  to  be  constant  unless  the  user  commands  a change  In  flight. 
Therefore,  the  navigation  constant  might  Initially  be  modelled  as  a 
random  bias 


n(t)  - 0 


(119) 


62 


where  n(t  ) Is  a Gaussian  random  Variable  of  mean,  m , and  variance 
o o 

P^.  Hathematlcally,  the  bias  model  tells  the  filter  that  the  constant 
does  not  change  In  time,  but  Its  value  Is  not  known  aprlorl.  The  filter 
will  determine  Its  estimate  of  the  constant  on  early  measurements  and 
disregard  measurements  that  come  later  (l.e.  the  Kalman  gain  goes  to 
zero  on  the  bias  channel).  Since  the  value  of  the  navigation  constant 
can  be  changed,  an  Inability  to  re-estlmate  Its  new  value  would  be  highly 
undesirable.  Therefore,  pseudonoise  Is  added  to  the  navigation  constant 
channel  to  ensure  the  gain  does  not  go  to  zero  (Ref  9:159).  In  addition, 
and  based  upon  the  discussion  In  the  Guidance  Section  of  Chapter  Two,  a 
navigation  constant  limiter  with  a range  of  three  to  six  Is  Implemented 
In  the  filter. 

The  coefficient  of  zero-lift  drag  can  be  described  as 


C 


DO 


/r 


(120) 


where  the  expression,  V /A,  has  been  substituted  for  the  Mach,  M,  In 

m 

Equation  (28).  A Is  the  speed  of  sound  at  the  appropriate  altitude. 
In  addition,  to  give  an  expression  for  Equation  (25)  Is  repeated 


“DI 


From  a curve  fit  to  a generic  missile,  can  be  expressed  as 

P ai  A 

No  M " V 
m 


(121) 


where  the  constant,  approximately  equal  to  one  and  the  substitu- 

tion of  V /A  was  made  for  the  Mach.  An  expression  for  C.  Is  found  In 
m L 
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Eqtiatlon  (27) 


2na^ 


Substituting  Equations  (27)  and  (121)  Into  Equation  (25)  yields 


C 


DI 


Am 


2^2, 
p S A 


(122) 


This  e3q>resslon  for  Is  Intuitively  pleasing.  As  expected,  the  Induced 
drag,  vls-a-vls  the  missile  Increases  as  lateral  acceleration 

3 

Increases.  The  V tern  in  the  denominator  accounts  for  the  fact  that 
m 

greater  lateral  acceleration  Is  required  for  control  at  lower  velocities. 
Substituting  the  expressions  for  and  into  the  expression  for 
In  Equation  (44)  yields 


1 ,2  a,  - 

m m 


(123-a) 


By  substituting  in  the  expression  for  a^  from  Equation  (2)  and  expanding, 
this  becomes 


(123-b) 


m 

1/2 

In  Equation  (123-b),  the  factors,  pA  and  2/pA  are  assumed  to  be 
deterministic  constants.  This  Is  a valid  assumption  for  the  constant 
altitude  case.  Even  with  removal  of  the  constant  altitude  assumption, 
p and  A will  vary  little  during  a typical  alr-to-air  engagement.  If 
desired,  and  if  warranted  by  performance  enhancement,  a more  sophisticated 


model  could  Include  the  variation  In  these  parameters.  The  quantities 

(7)*  n,  and  V In  Equation  (123-b)  are  defined  as  states  while  V and 
be  m 

e,j,  are  defined  as  parameters.  The  rationale  for  the  decision  about  the 
latter  two  quantities  follows  the  discussion  of  0^  In  the  L-Filter 
development.  The  ratio  of  ^ Is  modelled  as  a random  bias 


(f)(t)  - w(t) 


(124) 


Conceptually,  this  makes  sense  for  a non-thrusting  missile.  It  is  assumed 
that  [?J(t  ) Is  a Gaussian  random  variable  of  mean  m , and  variance 

Again,  a pseudonoise,  w(t).  Is  added  to  the  model  to  ensure  a non- 
zero gain  on  the  [^]  channel.  In  the  extreme  case,  this  parameter  could 
detect  a change  In  target  status  (l.e.  an  abrupt  change  In  this  parameter 
could  be  Indicative  of  target  damage  or  destruction).  The  first  five 
states  of  the  UP-Fllter  are  Identical  to  the  corresponding  states  In  the 
L-Fllter.  Three  of  the  system  equations,  however,  take  a radically 
different  form.  States  two  and  three,  and  now  vary  according  to 


• J. 

V ” -a_slnv  + a, COSY 
mx  D m 1 m 


(125) 


(126) 


Substituting  in  Equations  (123-b)  and  (2)  for  a^  and  a^^^  respectively 


,l/2„3/2,S 


.[pA--v;'-(^)  + (^)(^ 


2 2*2 

nVe*^ 

m.  c 


Islny  + nV  Ocosy 
m c m 


(127) 
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(128) 


+ (— )(f)  " / ■ ]co8Y  - nV  eslny 
m m pA  S m ™ ^ ® 


State  five,  the  range  rate  (R),  requires  an  expression  for  the  missile 

TLOS 

llne-of-slght  acceleration,  a . This  can  be  obtained  by  taking  the 

inx 

x-component  of 


TLOS  _TLOS  I 
a ■ C_  a 
— m I — tn 


(129) 


TLOS  I 

where  a and  a are  the  expressions  for  the  missile  acceleration 
~m  — m 

expressed  In  the  TLOS  and  I frames  respectively.  Substituting  Equations 
(42),  (127),  and  (128)  Into  this  expression  yields 


TLOS 

a 

-m 


a^  cos6_  + a^  sln6„ 
mx  T my  T 

-a^  sln6_  + a^  co80„ 
mx  T my  T 


0 


(130) 


and  thus 


TLOS  I o a.  I ^ 
a ■ a co80«  + a sln0_ 
mx  mx  T my  T 


(131) 


Substituting  Equation  (131)  Into  the  fifth  system  equation  of  the  L-Fllter 


and  using  Equations  (127)  and  (128)  for  a^  and  a^^  respectively  yields 


n 


n2y2-2 

+ nvJco,y^lco,e^  + [-„a1''(|)v3«co.y„  - (fexf)  “T”  cosy, 

n 


- nV  0slnY„]sln0_}  - a^°® 


(132) 


as  the  fifth  system  equation  for  the  UP-Filter.  The  angle,  0,  and  range 
rate,  ft,  equations  are  the  same  as  described  in  the  L-Filter.  The  final 
two  states  of  the  filter  are  the  proportional  navigation  constant  n and 
the  (m/s)  coefficient.  The  system  equations  of  the  UP-Fllter  are 
summarized  by  (for  sln0^  ^ . 707) 


Xj^(t) 


Xj(t) 


fjL[x(t),u(t),t]  - — cot  x^(t)  + 

4'’  "4 


’tx  ■ *2*''  , , 

x,(t) 


f [x(t),u(t),t]  - -(pA^^^vy^slny  ) (i-) 
i-  m m X- 


29  sinYjjj  ^ 2 

^AV ^*7VS^ 


m 


Xj(t) 


1/2„3/2. 


f,[x(t),u(t),t]  - -(pA  V cosY„)( — ") 


m m X, 


•2 

20  COSY 


m . 2 2 


^AV <*7*6*5^  ■ 


m 


x^(t)  - f^[x(t),u(t),t]  - x^(t) 


1/2„3/2.,„.  ,1 


x,.(t)  - f^[x(t),u(t),t]  - 0‘x^  + {[-pA"-'"^V^'  slnY„(^) 


m m X. 


20  alnYjij  ^ 2 

ilT 0cosY^(x5Xg)]cos  x^ 


m 


+ [-pA^^V^^cosy  (—V  . 2 2. 

“ ”*  *7^  - -^AV <*7V6^ 


m 


- 0slnYjjj(XjXg)]sin  Xj^}  - 


(13: 


(134 


(13f 


(136 


(137 


XgKn)  “ fg[x(t),u(t),t]  + Wg(t)  » Wg(t) 


(138) 


x^(t)  - f^[x(t),u(t),t]  + w^(t)  - Wy(t) 


(139) 


where 


X-  - V 

2 mx 

trl 

X-  ■ V 

3 my 

X,  “ R 

4 


Note  that 


X.  = V 
5 c 

Xg  - n 

x^  = m/s 


S * T,  / 2 . 2.1/2  ^ -1,*2. 

*T  ■ 'r  \ * <’'2  + ' V ■ 


(140) 


These  quantities  are  treated  as  constants  when  the  elements  of  the  F-matrlx 
are  calculated.  This  approach  avoids  further  complexity  In  both  the  sys- 
tem equations  and  the  F-matrlx.  Unlike  the  L-Fllter,  the  two  velocities, 

and  , can  both  be  estimated  - even  In  the  planar  case.  The 
mx  my 

structure  of  the  system  equations  allows  for  this,  despite  the  fact  the 
two  velocities  are  not  Independent.  In  addition,  the  same  switching 
mechanism  Is  utilized  for  the  6^  equation.  Of  the  three  parameters,  n, 

Cjjo»  Cjjj,  only  the  first  Is  estimated  directly  by  the  UP-Fllter.  It  Is 
obvious,  however,  that  the  quantities  required  to  calculate  and 
are  available  In  the  filter.  Consideration  had  been  given  to  modelling 
the  parameters  and  as  random  walks.  However,  this  approach 
neglects  the  dominant  effects  of  the  lateral  acceleration  and  missile 
velocity  on  these  two  parameters  and  thus  on  the  acceleration  of  the 
missile.  The  UP-Fllter  embodies  a highly  nonlinear,  coupled  set  of 
differential  equations.  The  primary  assumptions  made  In  the  filter 
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development  are:  (1)  the  geometry  of  the  forces  acting  on  the  missile, 

(2)  the  defining  relations.  Equations  (122)  and  (28),  for  the  parameters 
and  C^,  (3)  the  zero  order  model  for  the  missile  (l.e.  Instantaneous 

e 

time  response)  - also  true  In  L-Fllter,  and  (4)  9_,  y , and  V being 

T m m 

treated  as  constant  quantities  over  a propagation  period.  In  addition 

to  the  F matrix,  the  G,  Q,  R,  H,  x , and  P matrices  for  this  filter  are 

— -»•  — — — o — o 

listed  In  Appendix  A. 

Having  developed  the  system  equations  for  the  two  Extended  Kalman 
Filters,  and  provided  with  a nominal  trajectory,  it  Is  now  possible  to 
evaluate  the  prediction  and  estimation  capability  of  the  two  filters. 
Chapter  Four  discusses  the  analysis  approach  and  "tuning"  techniques 
used  In  the  evaluation. 


J 


i 


IV.  Discussion 


Introduction 

The  primary  objective  of  this  study  Is  to  determine  the  feasibility 
of  the  modelling  approach  taken  In  the  Unknown  Parameter  Filter.  To 
accomplish  this  objective.  It  Is  necessary  to  establish  the  ability  of 
the  filter  to  track  an  Incoming  missile  and  to  establish  some  degree  of 
confidence  In  Its  ability  to  recover  from  Initial  state  estimate  errors. 

To  determine  the  ability  of  the  filter  to  track  the  missile,  Its  performance 
Is  compared  against  that  of  a more  conventional  system  model  (l.e.  the 
Landau  Filter).  The  analysis  of  the  two  Extended  Kalman  Filters  Is 
carried  out  entirely  as  a Monte  Carlo  computer  simulation.  The  truth 
model  provides  nominal  measurements  to  the  filters  (reference  Chapter  One). 
The  filters  use  the  measurements  to  generate  estimates  of  the  system  states. 
The  "true  states"  are  compared  to  the  estimated  states  and  the  sample 
statistics  generated  to  describe  the  resulting  error  process. 

In  this  chapter,  the  choice  of  the  trajectory  profiles  and  Initial 
conditions  are  discussed.  In  addition,  the  criteria  used  to  analyze  and 
compare  the  two  filters  are  Introduced.  Tlnally,  the  filter  tuning 
philosophy  Is  presented.  Prior  to  discussing  the  trajectory  profiles. 

It  Is  Important  to  recall  that  the  emphasis  In  this  study  Is  not  to 
generate  tuned  filters,  but  rather  to  determine  the  feasibility  of  the 
UP-Fllter,  and  to  conduct  a general  comparison  of  Its  performance  against 
that  of  the  L-Fllter.  Therefore,  as  will  be  seen  subsequently,  the  major 
analysis  effort  Is  Involved  with  the  Unknown  Parameter  Filter. 

nominal  Trajectories 

The  basis  for  the  comparison  and  recovery  analysis  are  the  two 
nominal  trajectories  generated  by  the  truth  model.  The  choice  of 


trajectories  has  been  limited  to  the  region  in  which  the  sine  of  the  LOS 
angle,  0^,  is  greater  than  .707  (reference  Figure  12).  This  eliminates 
any  problems  associated  with  switching  and  reduces  the  tuning  require- 
ments in  the  study.  In  addition,  the  truth  model  allows  for  missile 
acceleration  up  to,  but  not  exceeding  15  g's.  The  two  trajectories  chosen 
do  not  exercise  the  full  dynamic  range  of  the  missile.  Due  to  time 
constraints,  a full  study  of  "worst  case"  trajectories  is  not  feasible. 
Therefore,  as  depicted  in  Figure  16,  the  two  trajectories  chosen  represent 
a low-g  and  moderate-g  trajectory.  Table  II  lists  those  parameters  that 
determine  the  character  of  the  two  respective  trajectories  [reference 
Figure  12  and  Equations  (48-a)  and  (48-b)]. 


Table  II 

Time  (t  ) Parameter  Values 
o 


Parameter 

Low-g  Trajectory 

High-g  Trajectory 

R,  range 

10,000  ft 

10,000  ft 

V^,  missile  velocity 

3,051  ft/sec 

3,051  ft/sec 

missile  lead  angle 

3.5  deg 

0 deg 

Yjjj,  missile  inertial  heading 

20  deg 

30  deg 

Y.J,,  tracker  inertial  heading 

32  deg 

0 deg 

h) 

500 

0 

h 

2864.51 

0 

► tracker  dynamics 

800 

920 

^4 

0 

0 

U)  / 

.17455 

.17455 

n,  pro-nav  constant 

4.0 

4.0 

While  this  approach  does  not  fully  exercise  the  algorithms  developed, 
it  is  consistent  with  the  objective  of  establishing  concept  feasibility. 
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As  will  be  seen  in  Chapter  Five,  the  recovery  analysis  of  the  UP-Filter 


is  accomplished  using  the  low-g  trajectory. 


Filter  Initialization 

In  addition  to  establishing  the  trajectory  profiles,  it  is  necessary 

to  initialize  the  filter  matrices.  (The  values  for  the  R,  Q,  P and  i 

— — o — o 

matrices  are  listed  as  part  of  Appendix  A.)  First,  the  initial  values 

for  both  the  state  estimates,  x(t  ),  and  covariance,  P(t  ),  must  be  spec- 

— o — o 

if led.  As  discussed  in  the  introduction  to  this  chapter,  filter  recovery 

from  bad  initial  state  estimates  constitutes  a major  portion  of  the 

analysis  effort.  To  establish  a basis  for  comparison  between  the  two 

filters,  however,  the  initial  state  estimates  are  chosen  equal  to  the 

true  values  of  the  states  (i.e.  zero  initial  error).  In  general,  this 

is  a good  initialization  procedure  for  a systematic  investigation  of 

the  filter  capabilities.  While  assuming  zero  initial  errors  is  appropriate 

for  an  initial  feasibility  study,  it  is  still  necessary  to  consider 

practical  Initialization  methods.  This  is  done  in  order  to  choose  values 

for  the  P matrix.  Two  methods  of  Initializing  state  estimates  are  the 
~~o 

use  of  time  (t  ) measurements  of  the  missile  launch  vehicle  and  missile, 
o 

and  the  use  of  intelligence  data  collected  on  possible  threats.  Time 

(t  ) measurements  refer  to  measurements  (made  by  the  tracker)  of  both 
o 

missile  launch  vehicle  and  missile  prior  to  Initialization  of  the  missile 
guidance  function.  Assuming  an  on  (or  nearly  on)  boreslght  launch  implies 
that  the  missile  will  depart  the  launch  vehicle  with  the  same  approximate 
inertial  heading  that  the  launch  vehicle  has  been  maintaining.  Recall 
that,  from  Chapter  Two,  missile  guidance  Initiation  is  assumed  to  occur 
simultaneously  with  the  termination  of  missile  thrusting.  It  is  assumed 


that  the  launch  heading  is  Icnown  with  a relatively  high  degree  of  accuracy. 
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Combined  with  raw  range-rate  measurements,  this  heading  Information 

provides  the  Initial  estimates  of  the  Inertial  velocity  vectors,  and 

. The  Initialization  of  the  estimates  of  the  range,  range-rate,  and 
my 

angle  states  Is  straightforward  since  they  are  measured  directly  by 
system  sensors  (l.e.  raw  measurements  are  used  as  estimates).  The  last 
three  dynamic  states  considered  In  the  two  filters,  x,  y,  and  LOS 
accelerations,  can  be  Initialized  by  averaging  the  time  rate  of  change 
of  a small  number  of  velocity/ range-rate  measurements.  Finally,  Informa- 
tion about  the  unknown  parameters,  n and  (m/S),  can  come  from  Intelligence 

« 

sources  and  knowledge  of  the  current  state-of-the-art  In  missile  design. 
The  values  of  the  Initial  variances  are  chosen  to  reflect  the  estimation 
accuracy  given  by  these  Initialization  procedures. 

In  this  study.  It  Is  assumed  that  Is  a diagonal  matrix.  This 
assumption  Is  made  for  expediency  and  reflects  the  lack  of  a priori 
knowledge  of  any  cross  coupling  terms.  The  variances  for  the  measured 
states,  range,  range-rate,  and  angle,  can  be  calculated  by  summing  the 
low  frequency  portion  of  the  power  spectral  densities  of  the  thermal  and 
gllnt/sclntlllatlon  components  of  the  respective  measurements.  Recall 
that  the  thermal  and  gllnt/sclntlllatlon  components  are  considered 
Independent.  The  acceleration  states  of  the  L-Fllter  utilize  a standard 
deviation  that  Is  consistent  with  the  values  listed  In  Table  III  on  page 
76.  Since  the  Initial  values  of  the  velocity  states  are  computed  using 
other  estimates,  the  values  would  be  known  with  less  certainty.  There- 
fore, the  variances  of  these  states  are  chosen  to  reflect  less  confidence 

than  that  of  the  measured  range-rate  state,  but  of  the  same  order  of 

2 2 

magnitude.  The  Inertial  velocity  variances  are  set  equal  to  900  ft  /sec 

2 2 

as  compared  to  100  ft  /sec  for  the  range-rate  variance. 
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The  unknown  parameters  present  a different  problem.  Information 
about  the  unknown  parameters  will  come  from  Intelligence  sources  and 


knowledge  of  the  current  state-of-the-art.  A priori  knowledge  that  the 
navigation  constant  Is  between  three  and  six  Is  used  to  determine  an 
appropriate  standard  deviation,  l.e.  a - .5.  Therefore,  the  Initial 
variance  for  the  navigation  constant  Is  .25.  The  (m/S)  state  Is  not  as 
well  defined  as  the  navigation  constant.  Certainly  the  lower  absolute 
limit  Is  zero.  The  upper  limit,  however,  can  vary  over  a wide  range. 
Confidence  In  the  Intelligence  available  Is  the  primary  Influence  on 
the  Initial  covariance  value.  For  this  study,  the  (m/S)  of  a generic 
missile  Is  used  as  the  mean  value  of  the  range  of  possible  values  for 
this  parameter.  The  "standard  deviation"  Is  computed  using  this  mean 
value  and  the  lower  limit  of  zero  to  define  a "three-sigma"  Interval 
length. 

In  addition  to  establishing  Initial  estimates  and  variances  of  the 
states.  It  Is  necessary  to  determine  the  strengths  of  the  dynamic  driving 
noises,  w(b),  and  measurement  noises,  v(t),  l.e.  the  elements  In  the 
appropriate  covariance  kernels.  As  In  the  case  of  the  truth  model 
measurement  noises,  two  types  of  noise  models  are  used  In  the  filters. 

The  exponentially  time-correlated  noise  model  Is  used  In  the  L-Fllter 
to  model  the  x,  y,  and  LOS  accelerations.  Recall  that  this  model  Is  a 
first  order  lag  driven  by  a white  Gaussian  noise.  The  required  strength 
of  the  noise  for  this  model  Is  (Ref  9:178) 


reciprocal  of  the  time  constant 

standard  deviation  of  the  output  of  the  lag. 


! 

i. 


( 


> 


It  Is  apparent  from  this  expression  that  both  the  time  constant  and  the 
standard  deviation  determine  the  strength  of  the  required  driving  noise. 
Table  III,  listed  here  for  completeness,  lists  general  values  for  these 
quantities  (Ref  10:323,  5:30) 


Table  III 

Acceleration  Types 


Type 

2 

a(ft/sec  ) 

T(sec) 

small  accel . /slowly  varying 

10 

3 

large  accel . /slowly  varying 

64 

10 

large  accel. /rapidly  varying 

64 

1 

accel.  for  randomly  maneuvering 
aircraft 

96 

10 

The  application  of  the  values  In  this  table  are  discussed  In  the  last 
section  of  this  chapter.  The  two  pseudonoises  of  the  UP-Fllter  previously 
mentioned  and  pseudonoises  to  be  added  to  the  range-rate  and  angle  channels 
of  the  UP-Fllter  are  all  modelled  as  white  Gaussian  noises,  the  strength 
of  which  Is  denoted  as  q.  The  values  selected  for  these  noises  should 
In  general  reflect  the  expected  rate  of  change  In  the  parameter/state 
being  estimated.  The  unknown  parameters  are  expected  to  be  essentially 
constant,  but  adding  a pseudonoise  can  be  justified  In  order  to  keep  the 
associated  Kalman  gains  from  going  to  zero.  The  effect  of  different 
values  of  noise  strength  for  the  navigation  constant  are  discussed  In 
Chapter  Five.  The  Initial  noise  strengths  for  the  unknown  parameters 
are  kept  small  (l.e.  a noise  strength  of  .001  for  the  navigation  constant 
and  .0001  for  (m/S)).  The  noises  added  to  the  range-rate  and  angle 
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channels  are  added  to  ensure  that  possible  degradation  of  the  system 
model  over  time  Is  offset  by  "forcing"  the  filter  to  look  harder  at  update 
measurements  (l.e.  higher  variances  on  these  channels). 

Finally,  values  for  the  filter  measurement  noise,  v(t),  covariance 
matrix  must  be  selected.  The  Initial  values  for  the  matrix  can  be 
generated  by  equipment  specifications  and  are  obtained  In  the  same  manner 
as  used  for  the  Initial  state  variances  for  range,  range-rate,  and  angle. 
In  addition,  the  R matrix  Is  assumed  diagonal  for  the  same  reason  that 
F was. 


Performance  Criteria 

The  results  of  this  study  are  divided  Into  two  parts,  both  of  which 
are  located  In  Appendix  B.  The  first  part  consists  of  plots  of  mean 
estimation  errors  with  a one  standard  deviation  envelope  about  these 
errors.  These  quantities  are  calculated  as  sample  statistics  obtained 
from  repeated  runs  of  the  simulation.  Each  run  is  driven  by  a different 
noise  sample  from  a random  noise  generator.  The  foimulae  used  to  compute 
the  mean  error  are 


n 


X (t.) 
mean  j 


e„__(t,) 
mean  j 


— S X (tj 
n comp . ' J 
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I 
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where  n Is  the  number  of  runs,  x 


(142) 


(143) 


(t.)  Is  the  filter  computed  value 


comp^ ' ■ j 

of  the  state  of  Interest  at  time  tj , (on  the  1-th  simulation  run) , and 

X (t,)  Is  the  true  or  truth  model  value  of  the  state  of  Interest  at 
true'  J' 

time  t, . The  notation  e (t.)  Indicates  the  error  In  the  mean  at  time 
j mean  j ' 

(tj)  (Ref  7:16). 
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The  standard  deviation  is  then  given  by 


1 ^ 

7 S {x  (t,)  - X (t,)}' 

n - 1 comp , j mean  j 

' i-1  ^ 


1/2 


(144) 


(a 


(a^) 


It  is  important  to  note  the  use  of  \ .,  | in  this  expression  instead  of 
It  can  be  shown  that  the  quantity  inside  the  brackets  represents  an 
unbiased  estimate  of  the  variance  of  x(t).  However,  the  expression  for 


XsoCtj)  is  a biased  estimate  of  the  standard  deviation  for  small  sample 


sizes,  such  as  n^  * 5 in  this  study.  While  it  is  biased,  it  is  still  a 


better  estimate  than  would  have  been  obtained  by  utilizing  the  term  ry. 


I 


Methods  for  eliminating  the  bias  in  the  standard  deviation  estimate  are 

t 

presented  in  Reference  9 (Ref  9:8,  8:269).  These  statistical  character- 
istics provide  a good,  though  only  partial,  description  of  the  error 
characteristics  of  the  filters  under  investigation. 

The  second  part  of  the  results  are  plots  that  depict  the  tuning  of 
the  different  channels  of  each  of  the  two  filters.  This  is  accomplished 


by  comparing  the  filter  estimate  of  the  standard  deviation,  ’^j^j^(tj) » and 


the  computed  standard  deviation,  Xgp(tj).  The  objective  of  the  tuning 


process  is  to  minimize  the  computed  standard  deviation.  As  a rule  of 
thimb,  good  tuning  is  achieved  when  the  estimated  standard  deviation  is 
approximately  equal  to  the  computed  standard  deviation.  While  precise 
tuning  is  desirable  for  eventual  implementation,  it  is  not  essential  for 
a feasibility  study.  In  addition,  precise  filter  tuning  by  the  use  of 
Monte  Carlo  techniques  is  very  costly  in  terms  of  effort  and  time.  How- 
ever, this  part  of  the  results  provides  confidence  that  the  filter  per- 
formance noted  in  the  error  of  the  mean  results  are  representative  of 
the  filter's  fundamental  capabilities.  In  addition,  the  tuning  results 
may  provide  insights  into  the  reasons  for  performance  differences  between 
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the  two  filters,  and  nay  also  give  insights  for  filter  performance 
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enhancements . 

Tuning  Philosophy 

The  tuning  effort  Is  limited  due  to  time  constraints  and  the  overall 
objective  of  this  study.  It  Is  assumed  a priori  that  case  (1)  In  Table  III, 
namely  small,  slowly  varying  acceleration,  is  an  Inappropriate  model  for 
the  dynamics  of  a missile.  The  remaining  three  cases  are  all  considered 
as  possible  models. 

Landau  Filter.  The  general  tuning  procedure  for  this  filter  involves 
the  choice  of  an  acceleration  model  which  best  represents  the  ensemble  of 
expected  missile  accelerations.  The  actual  filter  performance  will  be 
degraded  to  the  extent  that  the  actual  target  acceleration  violates  the 
asstimed  acceleration  model.  In  actual  Implementation,  the  filter  model 
may  require  adaptive  settings  of  the  dynamic  driving  noise.  Due  to  the 
time  constraints  and  the  scope  of  this  study,  adaptive  techniques  are  not 
considered,  but  their  potential  benefits  can  be  discerned  from  performance 
sensitivity  analysis  Initiated  In  this  study.  The  tuning  process  Is 
concentrated  on  the  low-g  trajectory. 

For  the  Landau  Filter  the  tuning  process  consists  of  varying  the 

standard  deviation  and  time  constants  of  the  three  accelerations,  a^  , 

mx 

I TLOS 

a , and  a . In  addition,  the  standard  deviation  of  the  angle  measure- 
my  m 

ment  noise  component  was  varied.  The  three  standard  deviation  values 
that  were  tested  are  listed  In  Table  III.  The  lamda  (^)  values  were 
varied  from  ten  to  one-tenth  (l.e.  time  constants  of  one-tenth  of  a 
second  to  ten  seconds).  It  should  be  noted  that  this  original  tuning 
was  accomplished  by  evaluating  large  quantities  of  error  values  on 
computer  printouts.  The  use  of  plots  for  the  tuning  Is  preferable  to 


A 
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this  method,  but  was  not  utilized  due  to  a lack  of  computer  plotting 

availability  during  the  period  In  which  tunxng  was  being  considered. 

The  Initial  values  of  the  time  constant  and  standard  deviation  used  were 

Indicative  of  case  (3),  large,  rapidly  varying,  acceleration.  In  Table  III. 

The  time  constant  for  the  x and  LOS  acceleration  were  varied  from  one  second 

to  five  seconds  and  the  value  of  the  standard  deviation  was  set  equal  to 
2 

96  ft/sec  . Both  of  the  acceleration  models  displayed  Improved  performance 

as  the  time  constant  was  Increased  (l.e.  the  magnitude  of  the  errors  over 

the  majority  of  the  trajectory  were  decreased).  For  lower  time  constants, 

the  x-acceleratlon  model  displayed  slightly  better  performance  over  the 

higher  g portion  of  the  trajectory,  but  degraded  performance  over  a large 

portion  of  the  trajectory.  With  the  sane  standard  deviation,  the  time 

constants  of  the  two  accelerations  were  varied  from  five  seconds  to  ten 

seconds.  The  five  second  time  constant  for  the  LOS  acceleration  model 

continued  to  provide  the  best  performance.  A time  constant  of  seven 

seconds  was  found  to  provide  the  best  performance  for  the  x-acceleratlon 

model.  The  same  analysis  (l.e.  time  constant  variation)  for  the  two 

acceleration  models  was  accomplished  using  a standard  deviation  of 
2 

64  ft/sec  as  suggested  In  Reference  10.  The  values  finally  chosen  are: 

2 

0-96  ft/sec  , X_  » .2,  and  X •*  .14.  As  Indicated  In  Table  III,  these 
3 X 

values  describe  a missile  with  large,  slowly  to  moderately  varying, 
acceleration.  This  Is  consistent  with  the  profile  of  the  low-g  trajectory 
In  Figure  16. 

During  the  Initial  tuning  efforts.  It  was  found  that  the  velocity 
state  not  coupled  to  the  angle  state  Is  not  tunable.  Neither  It  nor  Its 
associated  random  acceleration  model  Is  coupled  In  any  way  to  the  other 
filter  states.  (The  value  of  this  state  Is  computed  as  a function  of 


the  other  estimated  values  [reference  Equation  (105-a)].  As  will  be  seen, 
this  Is  not  a problem  In  the  Unknown  Parameter  Filter. 

Due  to  the  dependency  of  the  velocity  estimate  on  the  angle  channel, 

It  was  decided  to  conduct  a limited  tuning  effort  with  the  angle  measure- 

_6  2 

ment  noise  strength.  The  noise  strength  was  varied  from  .5  x 10  rad 

_6  2 —6  2 
to  4 X 10  rad  . The  final  value  chosen  Is  1 x 10  rad  . 

Unknown  Parameter  Filter.  In  the  UP-Fllter,  as  originally  developed 
In  Chapter  Three,  the  filter  has  no  dynamic  driving  noises  If  both  the 
proportional  navigation  constant,  n,  and  (m/S)  parameter  are  modelled  as 
random  bias.  Recall  that.  In  Chapter  Three,  pseudonoises  are  suggested 
for  both  parameters.  In  view  of  the  assumptions  made  In  modelling  the 
UP-Fllter,  It  would  be  unrealistic  to  model  the  system  with  no  dynamic 
driving  noises.  No  system  noises  Imply  that  the  system  model  reflects, 
with  absolute  certainty,  the  true  system  state.  It  Is  equally  undesirable 
that  the  uncertainty  In  the  dynamic  states,  (l.e.  angle,  velocity,  range, 
and  range-rate  states),  be  so  dominant  that  the  coupling  effects  of  the 
two  parameters  are  not  readily  observable.  The  objective  then  Is  to  tune 
the  model  so  that  good  estimates  of  the  parameters  are  obtainable,  but 
that  If  poor  estimates  of  the  parameters  are  obtained,  the  estimates  of 
the  dynamic  states  are  not  severely  degraded.  The  philosophy  adopted  Is 
to  couple  the  two  parameters  Into  good  velocity  and  range  rate  estimates. 

To  assure  good  estimates  of  the  velocity  and  range-rate  states.  Irrespective 
of  the  quality  of  the  parameter  estimates,  an  additive  white  Gaussian  noise 
Is  added  to  the  range-rate  and  angle  states.  The  range-rate  noise  Is  added 
to  account  for  the  uncertainties  In  the  model  of  the  state.  The  angle 
noise  Is  added  to  account  for  uncertainties  In  the  angle  model  and  to 
ensure  that  the  angle  estlx'ates  remain  "good".  As  stated  In  the  preceding 
section  on  the  L-Fllter,  the  velocity  states  have  significant  coupling  to 
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the  angle  state.  Therefore,  the  accuracy  of  the  velocity  state  estimate 
Is  enhanced  by  a strong  coupling  to  the  angle  state,  but  the  dynamics  of 
the  state  can  still  be  sensitive  to  parameter  coupling  (l.e.  the  velocity 
state  la  driven  by  coupling,  not  noise  directly).  The  values  of  the  addi- 
tional noises  are  Indicated  In  the  system  noise  covariance  matrix,  In 
Appendix  A. 

An  alternative  to  adding  noise  to  the  angle  channel  would  be  to  add 

a pseudonoise  directly  to  the  x-veloclty  channel.  In  order  to  keep  the 

x-veloclty  estimate  sensitive  to  the  navigation  constant  channel.  It  was 

decided  that  the  value  of  this  pseudonoise  should  be  kept  small.  However, 

2 2 

when  a noise  of  strength  100  ft  /sec  was  added  to  the  x-velocity  channel, 
there  was  a negligible  effect  on  filter  performance.  Due  to  this  result, 
a time  constraint  on  the  research  effort,  and  the  fact  that  the  other 
method  had  already  Indicated  a limited  performance  capability.  It  was 
decided  to  pursue  the  method  presented  In  the  previous  paragraph  in  greater 
depth  and  to  not  add  a pseudonoise  to  the  x-velocity  channel. 

Finally,  it  should  be  noted  that,  unlike  the  L-Filter,  both  velocity 
states  are  tunable  for  all  values  of  sin0^.  However,  the  state  that  is 
not  coupled  into  the  angle  channel  displayed  relatively  poor  estimation 
capability.  Therefore,  both  for  comparison  with  the  L-Filter  and  for 
expediency,  the  state  not  coupled  to  the  angle  channel  was  computed  using 
the  estimates  of  the  other  states  and  not  estimated  [reference  Equation 


(105-a)]. 

This  chapter  has  established  the  techniques  and  criteria  by  which 
the  two  filters  will  be  compared  and  evaluated.  The  chapter  ended  with 
a discussion  of  the  tuning  philosophy  used  In  the  two  filters.  The 
results  of  the  tuning  are  found  In  the  second  part  of  Appendix  B.  Chapter 
Five  discusses  the  results  of  the  filter  comparison  and  analysis,  and 
discusses  the  findings  of  this  study. 


V.  Results  and  Conclusions 

Introduction 

The  Unknown  Parameter  Filter  Is  evaluated  using  the  criteria  and 
tuning  philosophy  discussed  In  Chapter  Four.  The  evaluation  consists 
of  both  a performance  comparison  between  the  UP-Fllter  and  th^^bre  conven- 
tional L-Fllter  and  an  evaluation  of  the  UP-Fllter' s capability  to  recover 
from  Initial  errors  In  state  estimates.  The  results  of  the  comparison  and 
recovery  analysis  are  presented  graphically  In  Appendix  B. 

In  Appendix  B,  the  results  are  divided  Into  two  sections.  The  first 
section  contains  plots  of  the  mean  estimation  errors  (±  one  standard  devia- 
tion) while  the  second  section  contains  the  tuning  plots;  both  types  of 
plots  are  described  In  Chapter  Four.  There  Is  a one-to-one  correspondence 
between  the  plots  of  the  two  sections.  (The  figure  number  of  the  tuning 
plot  which  corresponds  to  a plot  of  section  one  can  be  determined  by  add- 
ing 40  to  the  figure  number  of  the  plot  In  section  one.) 

The  results  provide  valuable  Insights  Into  the  capabilities  of  the 
UP-Fllter.  Most  Importantly,  they  establish  the  feasibility  of  utlliz-.^li^ 
Ing  the  UP-Fllter  to  track  an  Incoming  missile.  As  will  be  seen  sub- 
sequently, the  more  detailed  modelling  of  missile  dynamics  clearly 
enhances  the  filter's  tracking  capability.  The  estimates  provided  by 
the  UP-Fllter  are.  In  general,  less  sensitive  to  system  measurement 
noises  because  of  Its  more  complete  Internal  system  model. 

Further,  the  results  strongly  suggest  that  the  proportional  naviga- 
tion constant  can  be  estimated  by  the  UP-Fllter.  The  recovery  analysis 
provides  additional  Insights  Into  the  filter's  ability  to  estimate  this 
parameter.  It  gives  a general  Indication  of  the  effects  that  varying  the 
Initial  variance  and  noise  strength  (on  the  navigation  constant  channel) 
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have  on  the  tuning  and  recovery  characteristics  of  the  navigation  constant 
estimate. 

In  addition.  Insights  Into  the  adequacy  of  several  modelling  assumptions 
and  tuning  techniques  have  been  gained.  These  Insights  provide  a valuable 
basis  for  any  future  work  done  on  the  UP-Fllter. 

Finally,  the  results  of  this  study  are  found  to  be  consistent  with 
work  done  by  The  Applied  Science  Corporation.  This  fact  and  the  graphical 
results  obtained  In  this  study  provide  confidence  In  the  truth  model  upon 
which  the  analysis  Is  based.  The  remainder  of  this  chapter  discusses  the 
specific  results,  conclusions,  and  recommendations  generated  by  study. 

Filter  Comparison 

The  first  14  plots  of  Appendix  B present  a comparison  of  the  perform- 
ance of  the  two  filters  for  the  low-g  trajectory  and  the  next  14  compare 
performance  over  the  moderate-g  trajectory.  In  the  prior,  less  dynamic 
case,  the  performance  of  the  two  filters  Is  about  equal.  However,  for 
the  moderate-g  case,  the  performance  of  both  filters  Is  degraded,  and  the 
UP-Fllter  demonstrates  a far  greater  degradation  of  performance  than  does 
the  L-Fllter. 

The  "bias"  noted  in  the  x-veloclty  estimation  errors  of  the  UP-Fllter, 
Figures  (21)  and  (35),  provides  Insights  into  the  degradation  of  perform- 
ance. A characteristic  common  to  both  of  these  figures  Is  the  nearly 
Instantaneous  appearance  of  positive  estimation  error.  Recalling  that 
the  estimation  error  Is  computed  by  subtracting  the  estimated  value  of 
the  state  from  the  true  value.  It  Is  obvious  that  the  filter  Is  over- 
estimating the  deceleration  of  the  missile  In  the  positive  x direction. 

The  difference  In  deceleration  can  be  accounted  for  by  noting  that  the 
filter  utilizes  a zero  order  model  for  the  missile,  while  the  truth  model 
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utilizes  a second  order  model  and  responds  according  to  Its  performance 
parameters,  c ■ *707  and  u ••  .707.  The  effect  of  this  modelling  differ- 
ence can  be  seen  by  comparing  Figures  (21)  and  (35)  to  their  respective 
lateral  acceleration  profiles.  Figure  (16).  The  comparison  Indicates 
that  the  x-velocity  estimation  error  leads  the  actual  missile  accelera- 
tion/deceleration. The  higher  llne-of-alght  rates  present  In  the  moderate-g 
case  accentuate  the  effects  of  this  modelling  simplification.  It  should 
be  noted  that  the  decision  to  use  a zero-order  missile  model  was  consis- 
tent with  the  design  goal  of  developing  as  simple  a filter  as  would  pro- 
vide adequate  performance.  As  is  clearly  demonstrated  by  the  graphical 
results,  however,  this  model  does  not  provide  good  enough  performance. 
Despite  this  apparent  undermodelling  of  the  missile  in  the  UP-Filter 
system  model,  an  analysis  of  the  results  obtained  In  the  less  dynamic 
low-g  comparison  and  the  recovery  evaluation  provide  Insights  Into  the 
difference  In  capabilities  between  the  two  filters  and  the  feasibility 
of  estimating  the  unknown  parameters. 

The  narrower  one  standard  deviation  envelopes  about  the  mean  estima- 
tion errors  of  the  UP-Fllter  plots  suggest  both  an  advantage  and  possible 
disadvantage  of  the  UF-Fllter.  The  advantage  Is  the  fact  that  the  UP- 
Fllter  estimates  are  less  sensitive  to  measurement  noise,  l.e.  that  the 
filter  provides  a greater  degree  of  consistency  In  Its  estimates.  The 
disadvantage  Is  that,  while  the  filter  has  confidence  In  It's  estimates, 
these  estimates  may  In  fact  have  large  errors  due  to  unmodelled  or  mls- 
modelled  effects.  This  condition  is  common  to  any  filtering  problem  - 
the  accuracy  of  the  estimates  obtained  are  In  direct  relation  to  the 
accuracy  of  the  filter's  system  model.  The  narrow  one  standard  devia- 
tion envelopes  for  the  UP-Fllter  are  not  unexpected.  The  random  accelera- 
tion model  utilized  In  the  L-Fllter  admits  unmodelled  affects  and  keeps 
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the  filter's  bandwidth  open  (l.e.  higher  uncertainty  Is  present).  The 
advantage  of  the  UP-Fllter  Is  that  It  eliminates,  at  least  In  part,  some 
of  the  uncertainty  Inherent  In  the  model  within  the  L-Fllter  through  Its 
more  extensive  model  of  the  missile  guidance  function. 

In  general,  the  tuning  of  the  L-Fllter  Is  better  than  that  of  the 
UP-Fllter  [Ref  Figures  (58)  through  (71) ] . This  Is  most  obvious  In  the 
x-veloclty  tuning  comparison,  and  In  a comparison  of  the  tuning  of  the 
final  two  states  of  each  filter.  This  result  Is  probably  an  effect  of 
the  undermodelling  already  noted,  but  also  of  the  tuning  philosophy 
decision  made  In  Chapter  Four  (l.e.  the  decision  not  to  add  a pseudonoise 
to  the  x-veloclty  channel).  As  noted,  the  system  equation  for  the  x- 
veloclty  (as  well  as  the  y-veloclty  and  range-rate  system  equations)  do 
In  fact  have  unmodelled  effects.  Therefore,  It  appears  that  the  adopted 
tuning  philosophy  has  Increased  the  degradation  due  to  modelling  mismatch. 
In  other  words,  the  filter  has  been  given  the  capability  to  adjust  effec- 
tively only  the  parameter  estimates  In  response  to  differences  between 
measurement  and  estimate  values,  when  In  fact  It  required  the  capability 
to  adjust  dynamic  state  estimates  to  account  for  the  undermodelling  In 
these  states  as  well. 

The  strong  coupling  between  the  velocity  channels  (discussed  In 
Chapter  Four)  and  the  angle  channel  Is  seen  to  flow  In  both  directions. 
Both  filters  demonstrate  this  fact  In  the  moderate-g  trajectory  [Ref 
Figures  (32)  and  (33)].  In  general,  however,  the  angle  state  and  the 
other  states  directly  updated  by  measurements  reflect  better  performance 
than  the  other  states  during  both  trajectories  - again,  this  result  Is 
expected.  It  Is  seen,  however,  that  the  range-rate  estimates  of  the 
UP-Fllter  are  severely  degraded  In  the  presence  of  significant  dynamics 
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since  the  range-rate  model  Incorporates  the  erroneous  lateral  accelera- 
tion component  of  the  zero-order  missile  model. 

In  addition  to  the  coupling  already  mentioned,  the  errors  committed 
In  estimating  the  navigation  constant  and  (m/S)  parameter  demonstrate  a 
strong  coupling,  or  correlation.  In  all  the  system  equations  In  which 
the  parameters  appear,  they  both  appear.  This  may  account  for  the  "nega- 
tive" correlation  demonstrated  by  the  two  parameters  (l.e.  a positive 
error  In  the  navigation  constant  error  Is  accompanied  with  a negative 
error  In  the  (m/S)  parameter).  This  also  suggests  that  Independent 
estimates  of  both  the  navigation  constant  and  (m/S)  parameters  may  not 
be  obtainable.  It  may  also  account  for  some  part  of  the  Insensitivity 
the  other  states  exhibited  toward  the  navigation  constant  estimate. 

Recall  that  the  objective  of  the  tuning  philosophy  used  In  the  UP- 
Fllter  was  to  enhance  the  sensitivity  of  the  x-veloclty  state  to  the 
navigation  constant  estimate.  The  results  Indicate  that.  In  general, 
the  x-veloclty  Is  not  sensitive  to  the  navigation  constant  estimates. 
However,  the  navigation  constant  Is  seen  to  be  very  sensitive  to  the  other 
state  estimates  (primarily  the  velocity  state  estimate)  [Ref  Figures  (29) 
and  (43) ] . It  should  be  noted  that  the  error  In  the  navigation  constant 
tends  to  lag  the  error  In  the  x-veloclty  estimate.  This  lag  decreases, 
and  the  magnitude  of  the  errors  committed  In  estimating  the  navigation 
constant  Increase,  as  the  dynamics  of  the  tracking  problem  become  more 
pronounced . 

Recovery  Characteristics 

This  portion  of  the  evaluation  considers  the  UP-Fllter's  ability 
to  recover  from  Initial  errors  In  the  range,  x-veloclty,  and  navigation 
constant  estimates.  The  primary  emphasis,  however.  Is  on  the  recovery 
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characteristics  of  the  navigation  constant.  Figures  (46)  and  (47)  depict 
the  recovery  of  the  UP-Pllter  from  Initial  estimate  errors  In  x-veloclty 
and  range  respectively  (from  two  separate  runs).  While  the  recovery  Is 
positive,  it  requires  several  measurement  updates  before  the  estimates 
come  within  the  one  standard  deviation  envelope  of  the  mean  estimation 
error  plots  generated  previously.  When  compared  to  Figure  (57),  the 
L-Filter  recovery  from  an  initial  estimate  error  In  the  LOS  acceleration 
channel,  these  plots  further  support  the  assertion  that  the  UP-Filter  Is 
less  tuned  than  the  L-Fllter. 

The  recovery/sensltlvlty  analysis  of  the  navigation  constant  demon- 
strates the  lack  of  sensitivity  of  the  other  filter  states  to  the  naviga- 
tion constant  estimate.  Prior  to  discussing  this  point  and  the  effects 
of  varying  the  noise  strength  and  Initial  variance  of  the  navigation 
constant.  It  Is  necessary  to  recall  that  the  estimation  performance  on 
this  channel  Is  "biased"  due  to  the  undermodelling  noted  In  the  Filter 
Comparison  Section.  The  effect  of  the  bias  Is  readily  apparent  from  a 
comparison  of  cases  In  which  the  navigation  constant  Is  Initially  over- 
estimated, Figures  (48)  through  (50),  to  those  cases  In  which  It  Is 
underestimated.  Figures  (51)  through  (54) . The  biasing  "aids"  recovery 
from  an  overestimate  and  "prevents"  recovery  from  an  underestimate. 

Again,  however.  It  Is  possible  to  gain  some  Insights  Into  the  recovery/ 
sensitivity  characteristics  of  the  navigation  constant  parameter. 

The  series  of  Figures  (48)  through  (55)  depict  the  several  cases 
evaluated  In  the  recovery  analysis.  In  general.  It  Is  Indicated  that, 
given  a good  estimate  of  the  x-veloclty,  the  filter  can  estimate  the 
navigation  constant,  even  In  the  presence  of  initial  estimate  error. 

It  Is  seen  that  by  Increasing  the  dynamic  driving  noise  (pseudonoise) 
strength,  the  estimate  Is  made  to  converge  more  rapidly  on  the  true  value. 
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but  exhibits  an  oscillatory  steady  state  response.  It  should  be  noted 
that  too  high  a noise  strength  on  this  channel,  l.e.  q .5,  caused  the 
filter  estimate  of  that  parameter  to  diverge.  These  statements  suggest 
the  possible  use  of  an  adaptive  g-settlng  technique.  One  such  possibility 
Is  to  monitor  trends  In  the  estimates  of  the  parameter  (l.e.  If  a number 
of  successive  estimates  continue  to  Increase  or  decrease,  the  values  of 
the  driving  noise  would  be  Increased).  The  exact  number  of  estimates 
and  the  amount  of  Increase  In  q to  be  used  are  values  that  would  need  to 
be  determined  prior  to  Implementation.  The  "switching  case"  In  Figure 

(55)  demonstrates  both  the  divergent  and  convergent  effects  of  larger 
values  of  q.  For  this  case,  q Is  set  equal  to  .5  and  the  Initial  estimate 
of  the  navigation  constant  has  zero  error.  At  time,  t - 2.5,  the  naviga- 
tion constant  Is  switched  from  4.0  to  5.2.  The  errors  noted  In  the  plot 
reflect  the  "bias"  common  to  all  the  navigation  constant  plots  In  the 
study  (l.e.  x-veloclty/trajectory  related  errors).  However,  the  significant 
points  are  the  more  rapid  growth  and  decrease  noted  In  the  error  when 
using  the  larger  q. 

An  Increase  In  the  Initial  variance  of  the  navigation  constant  also 
provided  more  rapid  convergence,  but  also  a smoother  steady  state  response 
than  did  the  Increased  noise  strength.  Additionally,  It  Is  found  that, 
of  the  tuning  efforts  attempted,  an  Increase  In  the  Initial  variance 
demonstrated  the  "greatest"  effect  on  the  x-veloclty  channel  [Ref  Figures 

(56)  and  (96) ] . The  results  of  this  section  of  the  evaluation  support 
the  Idea  that  the  other  filter  states  are  relatively  Insensitive  to  the 
navigation  constant  estimate,  but  that  It  may  be  possible  to  obtain  an 
estimation  capability  for  the  navigation  constant  - particularly  If  the 
(m/S)  parameter  Is  made  a deterministic  quantity  by  choosing  a representa- 
tive value  a priori. 
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Time  constraints  did  not  allow  for  a recovery/ sensitivity  analysis 
of  the  (m/s)  parameter.  As  noted  previously,  however,  it  does  not  appear 
that  Independent  estimates  of  it  and  the  navigation  constant  can  be  ob- 
tained. Due  to  the  low  dynamics  in  the  low-g  trajectory,  the  estimates 
of  the  (m/s)  parameter  are  generally  good.  The  correlation  between  its 
errors  and  those  of  the  navigation  constant,  however,  significantly  degraded 
the  precision  of  estimates  of  the  latter  quantity. 

Comparison  to  TASC  Results 

The  results  of  this  study  are  consistent  with  those  obtained  in 
studies  by  The  Applied  Science  Corporation  (TASC).  Essentially,  the  TASC 
study  concluded  that,  with  current  state-of-the-art  measurement  sensors, 
accurate  estimates  of  the  navigation  constant  cannot  be  obtained.  However, 
it  also  stated  that  if  higher  precision  measurements  become  available, 
estimation  of  the  constant  is  possible.  In  any  case,  they  have  found 
that,  by  Including  the  dynamics  of  the  missile  in  a filter  of  adequate 
fidelity,  one  can  obtain  better  estimates  than  those  obtained  using  a 
random  acceleration  model. 

In  their  model,  TASC  utilized  an  acceleration  model  comprised  both 
of  missile  dynamics  and  an  additive  random  component.  The  latter  is 
included  to  account  for  model  uncertainties,  but  degrades  the  ability  to 
estimate  the  navigation  constant  (beyond  a certain  strength  of  noise,  the 
degradation  is  proportional  to  the  magnitude  of  the  random  component). 

Conclusions  and  Suggested  Future  Study 

This  study  has  proposed  an  Extended  Kalman  Filter  design  to  be 
utilized  in  the  missile  tracking  problem  (UP-Fllter) . In  comparison  to 
a filter  utilizing  a random  acceleration  model,  it  has  demonstrated  a 
limited  capability  to  obtain  estimates  of  comparable  accuracy  and  of  less 
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sensitivity  to  system  measurement  noises.  However,  the  study  demonstrates 
the  requirement  for  a higher  order  missile  model  to  be  Included  In  the 
UP-Fllter  system  model.  This  In  turn  requires  an  additional,  preferably 
more  precise,  tuning  of  the  remodelled  filter.  The  graphical  results  of 
the  study  clearly  depict  the  mismatch  between  the  truth  model  and  filter 
model. 

Several  methods  are  available  for  accomplishing  the  required  model- 
ling. Either  a first  or  second  order  missile  model  could  be  Included  In 
the  filter.  The  uncertainties  of  the  model  could  be  accounted  for  by 
using  the  method  employed  by  TASC,  utilizing  an  adaptive  g-settlng  tech- 
nique, or  by  using  a combination  of  techniques,  (l.e.  to  Include  adaptive 
g-settlng  for  some  pseudonoises) . The  noise  strength  of  the  appropriate 
channels  could  be  adjusted  according  to  the  rate  of  change  of  the 
acceleration  calculated  In  the  filter. 

In  addition  to  remodelling  the  missile  and  retunlng  the  filter, 
the  addition  of  bias  correction  terms,  as  generated  by  higher  order  non- 
linear filters,  may  be  appropriate  (Ref  9:255).  The  addition  of  bias 
correction  terms  becomes  even  more  appropriate  If  the  filter  tuning 
results  In  weak  dynamic  driving  noises  (which  tend  to  accentuate  bias 
problems).  If  warranted,  higher  order  filters  could  be  utilized 
(Implementation  problems  may  become  the  limiting  factors). 

Besides  establishing  a limited  capability  of  the  filter,  the  study 
supports  the  feasibility  of  estimating  the  proportional  navigation 
constant.  It  demonstrates  an  overall  lack  of  system  sensitivity  to 
this  parameter,  but  a "correct"  response  of  Its  estimate  to  tuning  efforts. 
The  study  suggests,  however,  that  the  lack  of  sensitivity  may  be  a result 
of  the  coupling  between  the  navigation  constant  and  (m/S)  parameters. 
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It  is  suggested,  therefore,  that  future  efforts  consider  making 
the  (m/s)  parameter  a deterministic  quantity.  In  addition.  It  Is  suggested 
that  further  tuning  efforts  emphasize  precise  tuning  of  the  dynamic  driv- 
ing states  and  possible  use  of  the  previously  mentioned  adaptive  q-settlng 
techniques . 

The  feasibility  and,  to  a lesser  degree,  the  potential  performance 
capability  of  the  UP-Fllter  have  been  demonstrated  In  this  study.  While 
the  results  of  the  analysis  have  provided  several  Insights  Into  the  filter 


performance,  several  questions  remain  unanswered.  To  answer  these  ques- 
tions, the  performance  capability  of  the  UP-Fllter  must  be  more  fully 


determined.  The  recommendations  for  future  study  from  this  work  provide 
a basis  for  this  determination. 
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Appendix  A 


This  appendix  contains  the  development  and  listing  of  those  elements 
of  the  filter  algorithms  required  to  complete  the  development  of  the  Landau 
and  Unknown  Parameter  Filters.  More  specifically,  the  equations  for  the 
rate  of  change  of  the  LOS  angle,  0^,  and  for  the  rate  of  change  of  the 
closing  velocity,  V^,  (both  for  the  Landau  Filter)  are  developed.  In 

A 

addition,  the  P , x , R,  H,  G,  and  Q matrices  required  as  inputs  to  the 
filters  are  listed.  Finally,  the  partial  derivatives  that  comprise  the 
F matrix  elements  for  both  the  Landau  and  Unknown  Parameter  Filter  are 
listed. 


Derivation  of  Equations 


Figure  17  depicts  the  "inertial"  geometry  (planar  case)  of  the 
engagement  scenario.  In  this  figure,  R^^  and  R^j^j  are  the  inertial  posi- 
tion vectors  of  the  tracker  and  missile  respectively,  and  R is  the  target- 
to-misslle  range.  Recall  that  it  is  assumed  that,  for  the  time  period  of 
the  engagement,  the  tracker  Instruments  the  "inertial"  frame.  The  range 
vector  is  assumed  to  lie  along  the  positive  x-axls  of  the  line-of-sight 
at  all  times  (Figure  17). 


T(TLOS) 


(TRACKER) 


*^0T 


/ R 

^ -y  (MISSILE) 


Figure  17.  Inertial  Geometry  of  Engagement  Scenario 
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In  the  planar  case,  the  angular  velocity  of  the  TLOS-frame  with  respect 
to  the  Inertial  frame  Is 


“l(TLOS)  * ®T 


(145) 


From  Figure  (17) 


^OM  “ ^OT  ^ 


(146) 


By  utilizing  the  Theorem  of  Coriolis,  and  coordlnatlzlng  In  the  I-frame, 
the  Inertial  velocity  Is  found  to  be 


^P-TLOS  ^ ^“l(TLOS)  * 


(147-a) 


or  equivalently 


(147-b) 


where  In  the  above 

Pj  “ time  derivative  with  respect  to  the  I-frame 

Ptlos  “ derivative  with  respect  to  the  TLOS  frame 

R “ -V^  " negative  of  the  closing  velocity 

■ Inertial  velocity  of  the  missile 
m 

Vj  “ Inertial  velocity  of  the  tracker. 

Note  that  the  cross  product  term  results  In  a simple  product  In  the  planar 
case  (i.e.  employ  the  right-hand  rule).  Expressing  Equation  (147-b)  in 
component  form  yields  (reference  Figure  17) 
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Rcos6. 


Rsin0, 


■“l(TLOS)“®‘“®T 


“l(TLOS)’'“*«T 


and  finally,  solving  for 


• cos6„ 

,,  _ R T . TX  mx  1 . j a ^ in-f 

“l(TLOS)  R slne^  R slne^  ’ ®^"®T  - 


I (TLOS) 


R cose^  R cosG^  ’ ®^"®T  ^ 


These  equations  describe  the  angle  rate  system  equations.  The  alternate 
forms  are  required  to  ensure  that  the  value  for  does  not  go 

unbounded  as  0^  approaches  Nir  or  Ntt/2  respectively,  N - 1,2,3,* 

By  taking  the  derivative  of  each  of  the  terms  In  Equation  (147-a) 
with  respect  to  the  I-frame,  and  again  applying  the  Theorem  of  Coriolis 
and  coordlnatlzlng  In  the  I-frame,  we  obtain 


“ ^Pl*^OT  PtLOS^  “l(TLOS)  ^ ^TLOS^  PtLOS“i(TLOS)  * ^ 


“l(TLOS)  * ^TLOS^  “l(TLOS)  * ^“l(TLOS)  * 


This  can  be  rewritten  as 


\ ” ®T  ^ ^^“l(TLOS)  * + ^PtLOS“i(TLOS)  * 


'*■  ^“l(TLOS)  * ^“l(TLOS)  * 


(151) 


where 


a ■ Inertial  missile  acceleration 
m 

a^  > inertial  tracker  acceleration 

“ relative  acceleration  along  the  LOS 
o)i(tlos)  X R ■ Coriolis  acceleration  term 
^TLOs“l(TLOS)  * ^ “ tangential  acceleration  term 
“l(TLOS)  * ^“l(TLOS)  * " centripetal  acceleration  term. 

From  the  geometry  of  Figure  (17),  and  by  using  the  right-hand  rule,  it  is 
seen  that  the  Coriolis  and  tangential  acceleration  components  are  perpen- 
dicular to  the  LOS  and  do  not  contribute  to  the  LOS  acceleration  component. 
In  addition,  the  a^  and  a^  terms  must  be  transformed  into  the  TLOS-frame 
and  only  the  x-component  of  each  used  in  the  LOS  acceleration  equation. 
After  this  manipulation,  solving  for  yields 


2_  . TLOS  TLOS 

0)  R + a_  - a 

Tx  mx 


Extended  Kalman  Filter  (Defining  Parameters) 


(152) 


Landau  Filter 


Landau  Filter  states  are  6.^  (radians)  j 

(ft/sec) 

mx 

^my 
R (ft) 

R (ft/sec) 

TLOS  2. 

a (ft/ sec  ) 
m 

TLOS  , 2. 

a (ft/sec  ) 
mx 

TLOS  2. 

my 


*Note:  The  Q(3,3)  term  for  a is  set  equal  to  zero  for  sln6_  > .707. 

my  T — 
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1 X 10  ” 
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F 

— 

r— 

— 
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1 

0 0 0 0 

0 0 0 

0 

278.89  0 

H - 

0 

0 0 1 0 

0 0 0 

0 

0 201.64 

0 

0 0 0 1 

0 0 0 

I I —8 

F terms  for  V and  a are  set  equal  to  1 x 10  for  runs 
o my  my 


with  sin6_  > .707 


F(l,3)  * l/(x^co8Xj^) 


F(l,4)  - 


F(l,5)  ” -sinXj^/ (x^cosxj^) 


*2  ” *7 


F(2,j)  - 0 for  all  j ^ 7 


F(2,7)  = 1 


*3  " *8 


F(3,j)  = 0 for  all  j ^ 8 


F(3,8)  = 1 


^4  ~ ^5 


F(4,j)  - 0 for  all  J f*  5 


F(4,5)  - 1 


• r*  \2  . 

Xj  - (X^)  x^  + Xg  - a^^ 


F(5,l)  - F(5,2)  - F(5,3)  - F(5,5)  - F(5,7)  -F(5,8)  - 0 
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F(5,6)  - 1 


X,  X, 

6 ^3  ^ 


P(6,7)  - 0 for  all  j 1*  6 


F(6,6)  - - i 


*7  “ - - *7 

X 


F(7,j)  - 0 for  all  j 7 


F(7,7)  ~ -f- 


*8  " ' T_  *8 


F(8,j)  - 0 for  all  j 8 


F(8,8)  • 

y 


Unknown  Parameter  Filter 


Unknown  Parameter  Filter  states  are 


6^  (radians) 
(ft/sec) 

mX 

(ft/sec) 

my 

R (ft) 

R (ft/sec) 
n ( ~ ) 
_(m/S)  ( — )_ 
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*Note:  The  P (3,3)  term  for  Is  set  equal  to  1 x 10  ® for  the  case 

o my 


of  sln6^  ^ .707. 
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F-matrlx  partial  derivatives; 


0 

0 
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0 

0 


0 
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Appendix  B 
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This  Appendix  contains  the  graphical  results  of  the  study.  The 

Landau 

Filter  Is  designated  Filter  1 and  the  Unknown  Parameter  Filter  Is 

f 

f’’: 

; 

designated  Filter  2 . There  Is  a one-to-one  corresoondence  between  the 

‘5 

j 

; 

mean  estimation  error  plots  of  Section  One  and  the  tuning  plots  of  Section 
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Two. 
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Section 

One  (Mean  Estimation  Error  Plots) 

; 

1 

Figure 

Subiect 

t 

[18-31] 

Low-g  Trajectory  Comparison 

j 

18,  19 

Angle 

rl' 

■ 

20,  21 

x-veloclty 

i 

■< 

! 

22,  23 

y-veloclty 

24,  25 

Range 

-c 

3 

26,  27 

Range-rate 

28 

LOS-acceleratlon 

i 

s 

[ 

29 

Navigation  constant 

i 

f 

I , 

30 

x-acceleratlon 

i 

< 

Ij 

31 

(m/s)  parameter 

k 

i 

[32-45] 

Hlgh-g  Trajectory  Comparison 

] 

\ 

32,  33 

Angle 

V 

34,  35 

x-veloclty 

) 

i 

■ .1 

36,  37 

y-veloclty 

5- 

t 

f 

38,  39 

Range 

■1 

. 

1 

i 40,  41 

Range-rate 

’ i 

42 

LOS-acceleratlon 

f 

!;• 

43 

Navigation  constant 

1 

/ 

44 

x-acceleratlon 

i 

f 

i 

108 

i 

! > 

i 

Figure 
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Navigation  Constant  Switch;  t = 2.5  (n  = 4.0-»-5.2) 
Effect  on  x-velocity  of  (Fig  50) 

Filter  1 LOS-acceleratlon  recovery 


Section  Two  (Tuning  Plots) 
Figure 


[58-71] 

[72-85] 

86 

87 

[88-94] 

95 

96 

97 


Low-g  trajectory  tuning 

Hlgh-g  trajectory  tuning 

x-velocity  recovery  tuning 

Range  recovery  tuning 

Navigation  constant  recovery  tuning 

Navigation  constant  switch  tuning 

Fig  56  tuning 

Filter  1 LOS-acceleration  recovery 


Note:  The  scale  on  both  the  range  and  range-rate  plots  for  Filter  Number 

One  in  18  units  per  division.  The  scale  for  the  respective  plots  of 
Filter  Number  Two  is  30  units  per  division. 
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FIGURE  85.  n/S  CGEFFICIENT  TUNING  FILTER  2 
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Appendix  C 

This  Appendix  contains  the  computer  listing  and  an  'abbreviated  flow- 
chart of  the  program  utilized  In  the  study.  The  main  program,  LRN, 
Initializes,  propagates  and  updates  the  filter  estimates,  ^t  computes 
the  prediction  errors,  estimation  errors,  and  square  roots  of  the  diagonal 
elements  of  the  covariance  matrix,  and  prints  these  values  along  with  time 
onto  a local  file.  The  local  file  Is  then  stored  on  a permanent  file. 

The  nominal  measurements  for  the  filter  are  generated  by  combining 
the  value  of  the  true  states  (from  Subroutine  TRAJ)  with  a measurement 
noise  of  the  appropriate  strength  (from  Subroutine  NOISE) . Subroutine 
TRAJ,  together  with  the  noises  from  Subroutine  NOISE,  constitute  the 
truth  model. 

The  Monte  Carlo  analysis  is  accomplished  by  "seeding"  the  random 
number  generator,  noise  generator.  Subroutine  NOISE.  The  "seeding"  allows 
repeatability  of  the  noise  sequence  over  any  single  simulation  run.  The 
seed,  designated  in  the  program  as  JJ,  is  changed  for  each  of  the  five 
runs  for  a given  filter  simulation.  The  same  sequence  of  "seeds"  is  then 
used  for  the  five  runs  of  the  other  filter  (over  the  same  nominal 
traj  ectory) . 

The  flowchart  and  listing  that  follow  are  for  the  Unknown  Parameter 
Filter.  The  listing  contains  the  Integration  routine,  INTEE.  This  sub- 
routine was  made  available  by  Capt  Eric  K.  Llndbery  of  che  AF  Flight 
Dynamics  Lab. 
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